net/irda/irlap.c

   1 /*********************************************************************
   2  *
   3  * Filename:      irlap.c
   4  * Version:       1.0
   5  * Description:   IrLAP implementation for Linux
   6  * Status:        Stable
   7  * Author:        Dag Brattli <dagb@cs.uit.no>
   8  * Created at:    Mon Aug  4 20:40:53 1997
   9  * Modified at:   Tue Dec 14 09:26:44 1999
  10  * Modified by:   Dag Brattli <dagb@cs.uit.no>
  11  *
  12  *     Copyright (c) 1998-1999 Dag Brattli, All Rights Reserved.
  13  *     Copyright (c) 2000-2003 Jean Tourrilhes <jt@hpl.hp.com>
  14  *
  15  *     This program is free software; you can redistribute it and/or
  16  *     modify it under the terms of the GNU General Public License as
  17  *     published by the Free Software Foundation; either version 2 of
  18  *     the License, or (at your option) any later version.
  19  *
  20  *     This program is distributed in the hope that it will be useful,
  21  *     but WITHOUT ANY WARRANTY; without even the implied warranty of
  22  *     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  23  *     GNU General Public License for more details.
  24  *
  25  *     You should have received a copy of the GNU General Public License
  26  *     along with this program; if not, see <http://www.gnu.org/licenses/>.
  27  *
  28  ********************************************************************/
  29
  30 #include <linux/slab.h>
  31 #include <linux/string.h>
  32 #include <linux/skbuff.h>
  33 #include <linux/delay.h>
  34 #include <linux/proc_fs.h>
  35 #include <linux/init.h>
  36 #include <linux/random.h>
  37 #include <linux/module.h>
  38 #include <linux/seq_file.h>
  39
  40 #include <net/irda/irda.h>
  41 #include <net/irda/irda_device.h>
  42 #include <net/irda/irqueue.h>
  43 #include <net/irda/irlmp.h>
  44 #include <net/irda/irlmp_frame.h>
  45 #include <net/irda/irlap_frame.h>
  46 #include <net/irda/irlap.h>
  47 #include <net/irda/timer.h>
  48 #include <net/irda/qos.h>
  49
  50 static hashbin_t *irlap = NULL;
  51 int sysctl_slot_timeout = SLOT_TIMEOUT * 1000 / HZ;
  52
  53 /* This is the delay of missed pf period before generating an event
  54  * to the application. The spec mandate 3 seconds, but in some cases
  55  * it's way too long. - Jean II */
  56 int sysctl_warn_noreply_time = 3;
  57
  58 extern void irlap_queue_xmit(struct irlap_cb *self, struct sk_buff *skb);
  59 static void __irlap_close(struct irlap_cb *self);
  60 static void irlap_init_qos_capabilities(struct irlap_cb *self,
  61                                         struct qos_info *qos_user);
  62
  63 #ifdef CONFIG_IRDA_DEBUG
  64 static const char *const lap_reasons[] = {
  65         "ERROR, NOT USED",
  66         "LAP_DISC_INDICATION",
  67         "LAP_NO_RESPONSE",
  68         "LAP_RESET_INDICATION",
  69         "LAP_FOUND_NONE",
  70         "LAP_MEDIA_BUSY",
  71         "LAP_PRIMARY_CONFLICT",
  72         "ERROR, NOT USED",
  73 };
  74 #endif  /* CONFIG_IRDA_DEBUG */
  75
  76 int __init irlap_init(void)
  77 {
  78         /* Check if the compiler did its job properly.
  79          * May happen on some ARM configuration, check with Russell King. */
  80         IRDA_ASSERT(sizeof(struct xid_frame) == 14, ;);
  81         IRDA_ASSERT(sizeof(struct test_frame) == 10, ;);
  82         IRDA_ASSERT(sizeof(struct ua_frame) == 10, ;);
  83         IRDA_ASSERT(sizeof(struct snrm_frame) == 11, ;);
  84
  85         /* Allocate master array */
  86         irlap = hashbin_new(HB_LOCK);
  87         if (irlap == NULL) {
  88                 IRDA_ERROR("%s: can't allocate irlap hashbin!\n",
  89                            __func__);
  90                 return -ENOMEM;
  91         }
  92
  93         return 0;
  94 }
  95
  96 void irlap_cleanup(void)
  97 {
  98         IRDA_ASSERT(irlap != NULL, return;);
  99
 100         hashbin_delete(irlap, (FREE_FUNC) __irlap_close);
 101 }
 102
 103 /*
 104  * Function irlap_open (driver)
 105  *
 106  *    Initialize IrLAP layer
 107  *
 108  */
 109 struct irlap_cb *irlap_open(struct net_device *dev, struct qos_info *qos,
 110                             const char *hw_name)
 111 {
 112         struct irlap_cb *self;
 113
 114         IRDA_DEBUG(4, "%s()\n", __func__);
 115
 116         /* Initialize the irlap structure. */
 117         self = kzalloc(sizeof(struct irlap_cb), GFP_KERNEL);
 118         if (self == NULL)
 119                 return NULL;
 120
 121         self->magic = LAP_MAGIC;
 122
 123         /* Make a binding between the layers */
 124         self->netdev = dev;
 125         self->qos_dev = qos;
 126         /* Copy hardware name */
 127         if(hw_name != NULL) {
 128                 strlcpy(self->hw_name, hw_name, sizeof(self->hw_name));
 129         } else {
 130                 self->hw_name[0] = '\0';
 131         }
 132
 133         /* FIXME: should we get our own field? */
 134         dev->atalk_ptr = self;
 135
 136         self->state = LAP_OFFLINE;
 137
 138         /* Initialize transmit queue */
 139         skb_queue_head_init(&self->txq);
 140         skb_queue_head_init(&self->txq_ultra);
 141         skb_queue_head_init(&self->wx_list);
 142
 143         /* My unique IrLAP device address! */
 144         /* We don't want the broadcast address, neither the NULL address
 145          * (most often used to signify "invalid"), and we don't want an
 146          * address already in use (otherwise connect won't be able
 147          * to select the proper link). - Jean II */
 148         do {
 149                 get_random_bytes(&self->saddr, sizeof(self->saddr));
 150         } while ((self->saddr == 0x0) || (self->saddr == BROADCAST) ||
 151                  (hashbin_lock_find(irlap, self->saddr, NULL)) );
 152         /* Copy to the driver */
 153         memcpy(dev->dev_addr, &self->saddr, 4);
 154
 155         init_timer(&self->slot_timer);
 156         init_timer(&self->query_timer);
 157         init_timer(&self->discovery_timer);
 158         init_timer(&self->final_timer);
 159         init_timer(&self->poll_timer);
 160         init_timer(&self->wd_timer);
 161         init_timer(&self->backoff_timer);
 162         init_timer(&self->media_busy_timer);
 163
 164         irlap_apply_default_connection_parameters(self);
 165
 166         self->N3 = 3; /* # connections attempts to try before giving up */
 167
 168         self->state = LAP_NDM;
 169
 170         hashbin_insert(irlap, (irda_queue_t *) self, self->saddr, NULL);
 171
 172         irlmp_register_link(self, self->saddr, &self->notify);
 173
 174         return self;
 175 }
 176 EXPORT_SYMBOL(irlap_open);
 177
 178 /*
 179  * Function __irlap_close (self)
 180  *
 181  *    Remove IrLAP and all allocated memory. Stop any pending timers.
 182  *
 183  */
 184 static void __irlap_close(struct irlap_cb *self)
 185 {
 186         IRDA_ASSERT(self != NULL, return;);
 187         IRDA_ASSERT(self->magic == LAP_MAGIC, return;);
 188
 189         /* Stop timers */
 190         del_timer(&self->slot_timer);
 191         del_timer(&self->query_timer);
 192         del_timer(&self->discovery_timer);
 193         del_timer(&self->final_timer);
 194         del_timer(&self->poll_timer);
 195         del_timer(&self->wd_timer);
 196         del_timer(&self->backoff_timer);
 197         del_timer(&self->media_busy_timer);
 198
 199         irlap_flush_all_queues(self);
 200
 201         self->magic = 0;
 202
 203         kfree(self);
 204 }
 205
 206 /*
 207  * Function irlap_close (self)
 208  *
 209  *    Remove IrLAP instance
 210  *
 211  */
 212 void irlap_close(struct irlap_cb *self)
 213 {
 214         struct irlap_cb *lap;
 215
 216         IRDA_DEBUG(4, "%s()\n", __func__);
 217
 218         IRDA_ASSERT(self != NULL, return;);
 219         IRDA_ASSERT(self->magic == LAP_MAGIC, return;);
 220
 221         /* We used to send a LAP_DISC_INDICATION here, but this was
 222          * racy. This has been move within irlmp_unregister_link()
 223          * itself. Jean II */
 224
 225         /* Kill the LAP and all LSAPs on top of it */
 226         irlmp_unregister_link(self->saddr);
 227         self->notify.instance = NULL;
 228
 229         /* Be sure that we manage to remove ourself from the hash */
 230         lap = hashbin_remove(irlap, self->saddr, NULL);
 231         if (!lap) {
 232                 IRDA_DEBUG(1, "%s(), Didn't find myself!\n", __func__);
 233                 return;
 234         }
 235         __irlap_close(lap);
 236 }
 237 EXPORT_SYMBOL(irlap_close);
 238
 239 /*
 240  * Function irlap_connect_indication (self, skb)
 241  *
 242  *    Another device is attempting to make a connection
 243  *
 244  */
 245 void irlap_connect_indication(struct irlap_cb *self, struct sk_buff *skb)
 246 {
 247         IRDA_DEBUG(4, "%s()\n", __func__);
 248
 249         IRDA_ASSERT(self != NULL, return;);
 250         IRDA_ASSERT(self->magic == LAP_MAGIC, return;);
 251
 252         irlap_init_qos_capabilities(self, NULL); /* No user QoS! */
 253
 254         irlmp_link_connect_indication(self->notify.instance, self->saddr,
 255                                       self->daddr, &self->qos_tx, skb);
 256 }
 257
 258 /*
 259  * Function irlap_connect_response (self, skb)
 260  *
 261  *    Service user has accepted incoming connection
 262  *
 263  */
 264 void irlap_connect_response(struct irlap_cb *self, struct sk_buff *userdata)
 265 {
 266         IRDA_DEBUG(4, "%s()\n", __func__);
 267
 268         irlap_do_event(self, CONNECT_RESPONSE, userdata, NULL);
 269 }
 270
 271 /*
 272  * Function irlap_connect_request (self, daddr, qos_user, sniff)
 273  *
 274  *    Request connection with another device, sniffing is not implemented
 275  *    yet.
 276  *
 277  */
 278 void irlap_connect_request(struct irlap_cb *self, __u32 daddr,
 279                            struct qos_info *qos_user, int sniff)
 280 {
 281         IRDA_DEBUG(3, "%s(), daddr=0x%08x\n", __func__, daddr);
 282
 283         IRDA_ASSERT(self != NULL, return;);
 284         IRDA_ASSERT(self->magic == LAP_MAGIC, return;);
 285
 286         self->daddr = daddr;
 287
 288         /*
 289          *  If the service user specifies QoS values for this connection,
 290          *  then use them
 291          */
 292         irlap_init_qos_capabilities(self, qos_user);
 293
 294         if ((self->state == LAP_NDM) && !self->media_busy)
 295                 irlap_do_event(self, CONNECT_REQUEST, NULL, NULL);
 296         else
 297                 self->connect_pending = TRUE;
 298 }
 299
 300 /*
 301  * Function irlap_connect_confirm (self, skb)
 302  *
 303  *    Connection request has been accepted
 304  *
 305  */
 306 void irlap_connect_confirm(struct irlap_cb *self, struct sk_buff *skb)
 307 {
 308         IRDA_DEBUG(4, "%s()\n", __func__);
 309
 310         IRDA_ASSERT(self != NULL, return;);
 311         IRDA_ASSERT(self->magic == LAP_MAGIC, return;);
 312
 313         irlmp_link_connect_confirm(self->notify.instance, &self->qos_tx, skb);
 314 }
 315
 316 /*
 317  * Function irlap_data_indication (self, skb)
 318  *
 319  *    Received data frames from IR-port, so we just pass them up to
 320  *    IrLMP for further processing
 321  *
 322  */
 323 void irlap_data_indication(struct irlap_cb *self, struct sk_buff *skb,
 324                            int unreliable)
 325 {
 326         /* Hide LAP header from IrLMP layer */
 327         skb_pull(skb, LAP_ADDR_HEADER+LAP_CTRL_HEADER);
 328
 329         irlmp_link_data_indication(self->notify.instance, skb, unreliable);
 330 }
 331
 332
 333 /*
 334  * Function irlap_data_request (self, skb)
 335  *
 336  *    Queue data for transmission, must wait until XMIT state
 337  *
 338  */
 339 void irlap_data_request(struct irlap_cb *self, struct sk_buff *skb,
 340                         int unreliable)
 341 {
 342         IRDA_ASSERT(self != NULL, return;);
 343         IRDA_ASSERT(self->magic == LAP_MAGIC, return;);
 344
 345         IRDA_DEBUG(3, "%s()\n", __func__);
 346
 347         IRDA_ASSERT(skb_headroom(skb) >= (LAP_ADDR_HEADER+LAP_CTRL_HEADER),
 348                     return;);
 349         skb_push(skb, LAP_ADDR_HEADER+LAP_CTRL_HEADER);
 350
 351         /*
 352          *  Must set frame format now so that the rest of the code knows
 353          *  if its dealing with an I or an UI frame
 354          */
 355         if (unreliable)
 356                 skb->data[1] = UI_FRAME;
 357         else
 358                 skb->data[1] = I_FRAME;
 359
 360         /* Don't forget to refcount it - see irlmp_connect_request(). */
 361         skb_get(skb);
 362
 363         /* Add at the end of the queue (keep ordering) - Jean II */
 364         skb_queue_tail(&self->txq, skb);
 365
 366         /*
 367          *  Send event if this frame only if we are in the right state
 368          *  FIXME: udata should be sent first! (skb_queue_head?)
 369          */
 370         if ((self->state == LAP_XMIT_P) || (self->state == LAP_XMIT_S)) {
 371                 /* If we are not already processing the Tx queue, trigger
 372                  * transmission immediately - Jean II */
 373                 if((skb_queue_len(&self->txq) <= 1) && (!self->local_busy))
 374                         irlap_do_event(self, DATA_REQUEST, skb, NULL);
 375                 /* Otherwise, the packets will be sent normally at the
 376                  * next pf-poll - Jean II */
 377         }
 378 }
 379
 380 /*
 381  * Function irlap_unitdata_request (self, skb)
 382  *
 383  *    Send Ultra data. This is data that must be sent outside any connection
 384  *
 385  */
 386 #ifdef CONFIG_IRDA_ULTRA
 387 void irlap_unitdata_request(struct irlap_cb *self, struct sk_buff *skb)
 388 {
 389         IRDA_ASSERT(self != NULL, return;);
 390         IRDA_ASSERT(self->magic == LAP_MAGIC, return;);
 391
 392         IRDA_DEBUG(3, "%s()\n", __func__);
 393
 394         IRDA_ASSERT(skb_headroom(skb) >= (LAP_ADDR_HEADER+LAP_CTRL_HEADER),
 395                return;);
 396         skb_push(skb, LAP_ADDR_HEADER+LAP_CTRL_HEADER);
 397
 398         skb->data[0] = CBROADCAST;
 399         skb->data[1] = UI_FRAME;
 400
 401         /* Don't need to refcount, see irlmp_connless_data_request() */
 402
 403         skb_queue_tail(&self->txq_ultra, skb);
 404
 405         irlap_do_event(self, SEND_UI_FRAME, NULL, NULL);
 406 }
 407 #endif /*CONFIG_IRDA_ULTRA */
 408
 409 /*
 410  * Function irlap_udata_indication (self, skb)
 411  *
 412  *    Receive Ultra data. This is data that is received outside any connection
 413  *
 414  */
 415 #ifdef CONFIG_IRDA_ULTRA
 416 void irlap_unitdata_indication(struct irlap_cb *self, struct sk_buff *skb)
 417 {
 418         IRDA_DEBUG(1, "%s()\n", __func__);
 419
 420         IRDA_ASSERT(self != NULL, return;);
 421         IRDA_ASSERT(self->magic == LAP_MAGIC, return;);
 422         IRDA_ASSERT(skb != NULL, return;);
 423
 424         /* Hide LAP header from IrLMP layer */
 425         skb_pull(skb, LAP_ADDR_HEADER+LAP_CTRL_HEADER);
 426
 427         irlmp_link_unitdata_indication(self->notify.instance, skb);
 428 }
 429 #endif /* CONFIG_IRDA_ULTRA */
 430
 431 /*
 432  * Function irlap_disconnect_request (void)
 433  *
 434  *    Request to disconnect connection by service user
 435  */
 436 void irlap_disconnect_request(struct irlap_cb *self)
 437 {
 438         IRDA_DEBUG(3, "%s()\n", __func__);
 439
 440         IRDA_ASSERT(self != NULL, return;);
 441         IRDA_ASSERT(self->magic == LAP_MAGIC, return;);
 442
 443         /* Don't disconnect until all data frames are successfully sent */
 444         if (!skb_queue_empty(&self->txq)) {
 445                 self->disconnect_pending = TRUE;
 446                 return;
 447         }
 448
 449         /* Check if we are in the right state for disconnecting */
 450         switch (self->state) {
 451         case LAP_XMIT_P:        /* FALLTHROUGH */
 452         case LAP_XMIT_S:        /* FALLTHROUGH */
 453         case LAP_CONN:          /* FALLTHROUGH */
 454         case LAP_RESET_WAIT:    /* FALLTHROUGH */
 455         case LAP_RESET_CHECK:
 456                 irlap_do_event(self, DISCONNECT_REQUEST, NULL, NULL);
 457                 break;
 458         default:
 459                 IRDA_DEBUG(2, "%s(), disconnect pending!\n", __func__);
 460                 self->disconnect_pending = TRUE;
 461                 break;
 462         }
 463 }
 464
 465 /*
 466  * Function irlap_disconnect_indication (void)
 467  *
 468  *    Disconnect request from other device
 469  *
 470  */
 471 void irlap_disconnect_indication(struct irlap_cb *self, LAP_REASON reason)
 472 {
 473         IRDA_DEBUG(1, "%s(), reason=%s\n", __func__, lap_reasons[reason]);
 474
 475         IRDA_ASSERT(self != NULL, return;);
 476         IRDA_ASSERT(self->magic == LAP_MAGIC, return;);
 477
 478         /* Flush queues */
 479         irlap_flush_all_queues(self);
 480
 481         switch (reason) {
 482         case LAP_RESET_INDICATION:
 483                 IRDA_DEBUG(1, "%s(), Sending reset request!\n", __func__);
 484                 irlap_do_event(self, RESET_REQUEST, NULL, NULL);
 485                 break;
 486         case LAP_NO_RESPONSE:      /* FALLTHROUGH */
 487         case LAP_DISC_INDICATION:  /* FALLTHROUGH */
 488         case LAP_FOUND_NONE:       /* FALLTHROUGH */
 489         case LAP_MEDIA_BUSY:
 490                 irlmp_link_disconnect_indication(self->notify.instance, self,
 491                                                  reason, NULL);
 492                 break;
 493         default:
 494                 IRDA_ERROR("%s: Unknown reason %d\n", __func__, reason);
 495         }
 496 }
 497
 498 /*
 499  * Function irlap_discovery_request (gen_addr_bit)
 500  *
 501  *    Start one single discovery operation.
 502  *
 503  */
 504 void irlap_discovery_request(struct irlap_cb *self, discovery_t *discovery)
 505 {
 506         struct irlap_info info;
 507
 508         IRDA_ASSERT(self != NULL, return;);
 509         IRDA_ASSERT(self->magic == LAP_MAGIC, return;);
 510         IRDA_ASSERT(discovery != NULL, return;);
 511
 512         IRDA_DEBUG(4, "%s(), nslots = %d\n", __func__, discovery->nslots);
 513
 514         IRDA_ASSERT((discovery->nslots == 1) || (discovery->nslots == 6) ||
 515                     (discovery->nslots == 8) || (discovery->nslots == 16),
 516                     return;);
 517
 518         /* Discovery is only possible in NDM mode */
 519         if (self->state != LAP_NDM) {
 520                 IRDA_DEBUG(4, "%s(), discovery only possible in NDM mode\n",
 521                            __func__);
 522                 irlap_discovery_confirm(self, NULL);
 523                 /* Note : in theory, if we are not in NDM, we could postpone
 524                  * the discovery like we do for connection request.
 525                  * In practice, it's not worth it. If the media was busy,
 526                  * it's likely next time around it won't be busy. If we are
 527                  * in REPLY state, we will get passive discovery info & event.
 528                  * Jean II */
 529                 return;
 530         }
 531
 532         /* Check if last discovery request finished in time, or if
 533          * it was aborted due to the media busy flag. */
 534         if (self->discovery_log != NULL) {
 535                 hashbin_delete(self->discovery_log, (FREE_FUNC) kfree);
 536                 self->discovery_log = NULL;
 537         }
 538
 539         /* All operations will occur at predictable time, no need to lock */
 540         self->discovery_log = hashbin_new(HB_NOLOCK);
 541
 542         if (self->discovery_log == NULL) {
 543                 IRDA_WARNING("%s(), Unable to allocate discovery log!\n",
 544                              __func__);
 545                 return;
 546         }
 547
 548         info.S = discovery->nslots; /* Number of slots */
 549         info.s = 0; /* Current slot */
 550
 551         self->discovery_cmd = discovery;
 552         info.discovery = discovery;
 553
 554         /* sysctl_slot_timeout bounds are checked in irsysctl.c - Jean II */
 555         self->slot_timeout = sysctl_slot_timeout * HZ / 1000;
 556
 557         irlap_do_event(self, DISCOVERY_REQUEST, NULL, &info);
 558 }
 559
 560 /*
 561  * Function irlap_discovery_confirm (log)
 562  *
 563  *    A device has been discovered in front of this station, we
 564  *    report directly to LMP.
 565  */
 566 void irlap_discovery_confirm(struct irlap_cb *self, hashbin_t *discovery_log)
 567 {
 568         IRDA_ASSERT(self != NULL, return;);
 569         IRDA_ASSERT(self->magic == LAP_MAGIC, return;);
 570
 571         IRDA_ASSERT(self->notify.instance != NULL, return;);
 572
 573         /*
 574          * Check for successful discovery, since we are then allowed to clear
 575          * the media busy condition (IrLAP 6.13.4 - p.94). This should allow
 576          * us to make connection attempts much faster and easier (i.e. no
 577          * collisions).
 578          * Setting media busy to false will also generate an event allowing
 579          * to process pending events in NDM state machine.
 580          * Note : the spec doesn't define what's a successful discovery is.
 581          * If we want Ultra to work, it's successful even if there is
 582          * nobody discovered - Jean II
 583          */
 584         if (discovery_log)
 585                 irda_device_set_media_busy(self->netdev, FALSE);
 586
 587         /* Inform IrLMP */
 588         irlmp_link_discovery_confirm(self->notify.instance, discovery_log);
 589 }
 590
 591 /*
 592  * Function irlap_discovery_indication (log)
 593  *
 594  *    Somebody is trying to discover us!
 595  *
 596  */
 597 void irlap_discovery_indication(struct irlap_cb *self, discovery_t *discovery)
 598 {
 599         IRDA_DEBUG(4, "%s()\n", __func__);
 600
 601         IRDA_ASSERT(self != NULL, return;);
 602         IRDA_ASSERT(self->magic == LAP_MAGIC, return;);
 603         IRDA_ASSERT(discovery != NULL, return;);
 604
 605         IRDA_ASSERT(self->notify.instance != NULL, return;);
 606
 607         /* A device is very likely to connect immediately after it performs
 608          * a successful discovery. This means that in our case, we are much
 609          * more likely to receive a connection request over the medium.
 610          * So, we backoff to avoid collisions.
 611          * IrLAP spec 6.13.4 suggest 100ms...
 612          * Note : this little trick actually make a *BIG* difference. If I set
 613          * my Linux box with discovery enabled and one Ultra frame sent every
 614          * second, my Palm has no trouble connecting to it every time !
 615          * Jean II */
 616         irda_device_set_media_busy(self->netdev, SMALL);
 617
 618         irlmp_link_discovery_indication(self->notify.instance, discovery);
 619 }
 620
 621 /*
 622  * Function irlap_status_indication (quality_of_link)
 623  */
 624 void irlap_status_indication(struct irlap_cb *self, int quality_of_link)
 625 {
 626         switch (quality_of_link) {
 627         case STATUS_NO_ACTIVITY:
 628                 IRDA_MESSAGE("IrLAP, no activity on link!\n");
 629                 break;
 630         case STATUS_NOISY:
 631                 IRDA_MESSAGE("IrLAP, noisy link!\n");
 632                 break;
 633         default:
 634                 break;
 635         }
 636         irlmp_status_indication(self->notify.instance,
 637                                 quality_of_link, LOCK_NO_CHANGE);
 638 }
 639
 640 /*
 641  * Function irlap_reset_indication (void)
 642  */
 643 void irlap_reset_indication(struct irlap_cb *self)
 644 {
 645         IRDA_DEBUG(1, "%s()\n", __func__);
 646
 647         IRDA_ASSERT(self != NULL, return;);
 648         IRDA_ASSERT(self->magic == LAP_MAGIC, return;);
 649
 650         if (self->state == LAP_RESET_WAIT)
 651                 irlap_do_event(self, RESET_REQUEST, NULL, NULL);
 652         else
 653                 irlap_do_event(self, RESET_RESPONSE, NULL, NULL);
 654 }
 655
 656 /*
 657  * Function irlap_reset_confirm (void)
 658  */
 659 void irlap_reset_confirm(void)
 660 {
 661         IRDA_DEBUG(1, "%s()\n", __func__);
 662 }
 663
 664 /*
 665  * Function irlap_generate_rand_time_slot (S, s)
 666  *
 667  *    Generate a random time slot between s and S-1 where
 668  *    S = Number of slots (0 -> S-1)
 669  *    s = Current slot
 670  */
 671 int irlap_generate_rand_time_slot(int S, int s)
 672 {
 673         static int rand;
 674         int slot;
 675
 676         IRDA_ASSERT((S - s) > 0, return 0;);
 677
 678         rand += jiffies;
 679         rand ^= (rand << 12);
 680         rand ^= (rand >> 20);
 681
 682         slot = s + rand % (S-s);
 683
 684         IRDA_ASSERT((slot >= s) || (slot < S), return 0;);
 685
 686         return slot;
 687 }
 688
 689 /*
 690  * Function irlap_update_nr_received (nr)
 691  *
 692  *    Remove all acknowledged frames in current window queue. This code is
 693  *    not intuitive and you should not try to change it. If you think it
 694  *    contains bugs, please mail a patch to the author instead.
 695  */
 696 void irlap_update_nr_received(struct irlap_cb *self, int nr)
 697 {
 698         struct sk_buff *skb = NULL;
 699         int count = 0;
 700
 701         /*
 702          * Remove all the ack-ed frames from the window queue.
 703          */
 704
 705         /*
 706          *  Optimize for the common case. It is most likely that the receiver
 707          *  will acknowledge all the frames we have sent! So in that case we
 708          *  delete all frames stored in window.
 709          */
 710         if (nr == self->vs) {
 711                 while ((skb = skb_dequeue(&self->wx_list)) != NULL) {
 712                         dev_kfree_skb(skb);
 713                 }
 714                 /* The last acked frame is the next to send minus one */
 715                 self->va = nr - 1;
 716         } else {
 717                 /* Remove all acknowledged frames in current window */
 718                 while ((skb_peek(&self->wx_list) != NULL) &&
 719                        (((self->va+1) % 8) != nr))
 720                 {
 721                         skb = skb_dequeue(&self->wx_list);
 722                         dev_kfree_skb(skb);
 723
 724                         self->va = (self->va + 1) % 8;
 725                         count++;
 726                 }
 727         }
 728
 729         /* Advance window */
 730         self->window = self->window_size - skb_queue_len(&self->wx_list);
 731 }
 732
 733 /*
 734  * Function irlap_validate_ns_received (ns)
 735  *
 736  *    Validate the next to send (ns) field from received frame.
 737  */
 738 int irlap_validate_ns_received(struct irlap_cb *self, int ns)
 739 {
 740         /*  ns as expected?  */
 741         if (ns == self->vr)
 742                 return NS_EXPECTED;
 743         /*
 744          *  Stations are allowed to treat invalid NS as unexpected NS
 745          *  IrLAP, Recv ... with-invalid-Ns. p. 84
 746          */
 747         return NS_UNEXPECTED;
 748
 749         /* return NR_INVALID; */
 750 }
 751 /*
 752  * Function irlap_validate_nr_received (nr)
 753  *
 754  *    Validate the next to receive (nr) field from received frame.
 755  *
 756  */
 757 int irlap_validate_nr_received(struct irlap_cb *self, int nr)
 758 {
 759         /*  nr as expected?  */
 760         if (nr == self->vs) {
 761                 IRDA_DEBUG(4, "%s(), expected!\n", __func__);
 762                 return NR_EXPECTED;
 763         }
 764
 765         /*
 766          *  unexpected nr? (but within current window), first we check if the
 767          *  ns numbers of the frames in the current window wrap.
 768          */
 769         if (self->va < self->vs) {
 770                 if ((nr >= self->va) && (nr <= self->vs))
 771                         return NR_UNEXPECTED;
 772         } else {
 773                 if ((nr >= self->va) || (nr <= self->vs))
 774                         return NR_UNEXPECTED;
 775         }
 776
 777         /* Invalid nr!  */
 778         return NR_INVALID;
 779 }
 780
 781 /*
 782  * Function irlap_initiate_connection_state ()
 783  *
 784  *    Initialize the connection state parameters
 785  *
 786  */
 787 void irlap_initiate_connection_state(struct irlap_cb *self)
 788 {
 789         IRDA_DEBUG(4, "%s()\n", __func__);
 790
 791         IRDA_ASSERT(self != NULL, return;);
 792         IRDA_ASSERT(self->magic == LAP_MAGIC, return;);
 793
 794         /* Next to send and next to receive */
 795         self->vs = self->vr = 0;
 796
 797         /* Last frame which got acked (0 - 1) % 8 */
 798         self->va = 7;
 799
 800         self->window = 1;
 801
 802         self->remote_busy = FALSE;
 803         self->retry_count = 0;
 804 }
 805
 806 /*
 807  * Function irlap_wait_min_turn_around (self, qos)
 808  *
 809  *    Wait negotiated minimum turn around time, this function actually sets
 810  *    the number of BOS's that must be sent before the next transmitted
 811  *    frame in order to delay for the specified amount of time. This is
 812  *    done to avoid using timers, and the forbidden udelay!
 813  */
 814 void irlap_wait_min_turn_around(struct irlap_cb *self, struct qos_info *qos)
 815 {
 816         __u32 min_turn_time;
 817         __u32 speed;
 818
 819         /* Get QoS values.  */
 820         speed = qos->baud_rate.value;
 821         min_turn_time = qos->min_turn_time.value;
 822
 823         /* No need to calculate XBOFs for speeds over 115200 bps */
 824         if (speed > 115200) {
 825                 self->mtt_required = min_turn_time;
 826                 return;
 827         }
 828
 829         /*
 830          *  Send additional BOF's for the next frame for the requested
 831          *  min turn time, so now we must calculate how many chars (XBOF's) we
 832          *  must send for the requested time period (min turn time)
 833          */
 834         self->xbofs_delay = irlap_min_turn_time_in_bytes(speed, min_turn_time);
 835 }
 836
 837 /*
 838  * Function irlap_flush_all_queues (void)
 839  *
 840  *    Flush all queues
 841  *
 842  */
 843 void irlap_flush_all_queues(struct irlap_cb *self)
 844 {
 845         struct sk_buff* skb;
 846
 847         IRDA_ASSERT(self != NULL, return;);
 848         IRDA_ASSERT(self->magic == LAP_MAGIC, return;);
 849
 850         /* Free transmission queue */
 851         while ((skb = skb_dequeue(&self->txq)) != NULL)
 852                 dev_kfree_skb(skb);
 853
 854         while ((skb = skb_dequeue(&self->txq_ultra)) != NULL)
 855                 dev_kfree_skb(skb);
 856
 857         /* Free sliding window buffered packets */
 858         while ((skb = skb_dequeue(&self->wx_list)) != NULL)
 859                 dev_kfree_skb(skb);
 860 }
 861
 862 /*
 863  * Function irlap_setspeed (self, speed)
 864  *
 865  *    Change the speed of the IrDA port
 866  *
 867  */
 868 static void irlap_change_speed(struct irlap_cb *self, __u32 speed, int now)
 869 {
 870         struct sk_buff *skb;
 871
 872         IRDA_DEBUG(0, "%s(), setting speed to %d\n", __func__, speed);
 873
 874         IRDA_ASSERT(self != NULL, return;);
 875         IRDA_ASSERT(self->magic == LAP_MAGIC, return;);
 876
 877         self->speed = speed;
 878
 879         /* Change speed now, or just piggyback speed on frames */
 880         if (now) {
 881                 /* Send down empty frame to trigger speed change */
 882                 skb = alloc_skb(0, GFP_ATOMIC);
 883                 if (skb)
 884                         irlap_queue_xmit(self, skb);
 885         }
 886 }
 887
 888 /*
 889  * Function irlap_init_qos_capabilities (self, qos)
 890  *
 891  *    Initialize QoS for this IrLAP session, What we do is to compute the
 892  *    intersection of the QoS capabilities for the user, driver and for
 893  *    IrLAP itself. Normally, IrLAP will not specify any values, but it can
 894  *    be used to restrict certain values.
 895  */
 896 static void irlap_init_qos_capabilities(struct irlap_cb *self,
 897                                         struct qos_info *qos_user)
 898 {
 899         IRDA_ASSERT(self != NULL, return;);
 900         IRDA_ASSERT(self->magic == LAP_MAGIC, return;);
 901         IRDA_ASSERT(self->netdev != NULL, return;);
 902
 903         /* Start out with the maximum QoS support possible */
 904         irda_init_max_qos_capabilies(&self->qos_rx);
 905
 906         /* Apply drivers QoS capabilities */
 907         irda_qos_compute_intersection(&self->qos_rx, self->qos_dev);
 908
 909         /*
 910          *  Check for user supplied QoS parameters. The service user is only
 911          *  allowed to supply these values. We check each parameter since the
 912          *  user may not have set all of them.
 913          */
 914         if (qos_user) {
 915                 IRDA_DEBUG(1, "%s(), Found user specified QoS!\n", __func__);
 916
 917                 if (qos_user->baud_rate.bits)
 918                         self->qos_rx.baud_rate.bits &= qos_user->baud_rate.bits;
 919
 920                 if (qos_user->max_turn_time.bits)
 921                         self->qos_rx.max_turn_time.bits &= qos_user->max_turn_time.bits;
 922                 if (qos_user->data_size.bits)
 923                         self->qos_rx.data_size.bits &= qos_user->data_size.bits;
 924
 925                 if (qos_user->link_disc_time.bits)
 926                         self->qos_rx.link_disc_time.bits &= qos_user->link_disc_time.bits;
 927         }
 928
 929         /* Use 500ms in IrLAP for now */
 930         self->qos_rx.max_turn_time.bits &= 0x01;
 931
 932         /* Set data size */
 933         /*self->qos_rx.data_size.bits &= 0x03;*/
 934
 935         irda_qos_bits_to_value(&self->qos_rx);
 936 }
 937
 938 /*
 939  * Function irlap_apply_default_connection_parameters (void, now)
 940  *
 941  *    Use the default connection and transmission parameters
 942  */
 943 void irlap_apply_default_connection_parameters(struct irlap_cb *self)
 944 {
 945         IRDA_DEBUG(4, "%s()\n", __func__);
 946
 947         IRDA_ASSERT(self != NULL, return;);
 948         IRDA_ASSERT(self->magic == LAP_MAGIC, return;);
 949
 950         /* xbofs : Default value in NDM */
 951         self->next_bofs   = 12;
 952         self->bofs_count  = 12;
 953
 954         /* NDM Speed is 9600 */
 955         irlap_change_speed(self, 9600, TRUE);
 956
 957         /* Set mbusy when going to NDM state */
 958         irda_device_set_media_busy(self->netdev, TRUE);
 959
 960         /*
 961          * Generate random connection address for this session, which must
 962          * be 7 bits wide and different from 0x00 and 0xfe
 963          */
 964         while ((self->caddr == 0x00) || (self->caddr == 0xfe)) {
 965                 get_random_bytes(&self->caddr, sizeof(self->caddr));
 966                 self->caddr &= 0xfe;
 967         }
 968
 969         /* Use default values until connection has been negitiated */
 970         self->slot_timeout = sysctl_slot_timeout;
 971         self->final_timeout = FINAL_TIMEOUT;
 972         self->poll_timeout = POLL_TIMEOUT;
 973         self->wd_timeout = WD_TIMEOUT;
 974
 975         /* Set some default values */
 976         self->qos_tx.baud_rate.value = 9600;
 977         self->qos_rx.baud_rate.value = 9600;
 978         self->qos_tx.max_turn_time.value = 0;
 979         self->qos_rx.max_turn_time.value = 0;
 980         self->qos_tx.min_turn_time.value = 0;
 981         self->qos_rx.min_turn_time.value = 0;
 982         self->qos_tx.data_size.value = 64;
 983         self->qos_rx.data_size.value = 64;
 984         self->qos_tx.window_size.value = 1;
 985         self->qos_rx.window_size.value = 1;
 986         self->qos_tx.additional_bofs.value = 12;
 987         self->qos_rx.additional_bofs.value = 12;
 988         self->qos_tx.link_disc_time.value = 0;
 989         self->qos_rx.link_disc_time.value = 0;
 990
 991         irlap_flush_all_queues(self);
 992
 993         self->disconnect_pending = FALSE;
 994         self->connect_pending = FALSE;
 995 }
 996
 997 /*
 998  * Function irlap_apply_connection_parameters (qos, now)
 999  *
1000  *    Initialize IrLAP with the negotiated QoS values
1001  *
1002  * If 'now' is false, the speed and xbofs will be changed after the next
1003  * frame is sent.
1004  * If 'now' is true, the speed and xbofs is changed immediately
1005  */
1006 void irlap_apply_connection_parameters(struct irlap_cb *self, int now)
1007 {
1008         IRDA_DEBUG(4, "%s()\n", __func__);
1009
1010         IRDA_ASSERT(self != NULL, return;);
1011         IRDA_ASSERT(self->magic == LAP_MAGIC, return;);
1012
1013         /* Set the negotiated xbofs value */
1014         self->next_bofs   = self->qos_tx.additional_bofs.value;
1015         if (now)
1016                 self->bofs_count = self->next_bofs;
1017
1018         /* Set the negotiated link speed (may need the new xbofs value) */
1019         irlap_change_speed(self, self->qos_tx.baud_rate.value, now);
1020
1021         self->window_size = self->qos_tx.window_size.value;
1022         self->window      = self->qos_tx.window_size.value;
1023
1024 #ifdef CONFIG_IRDA_DYNAMIC_WINDOW
1025         /*
1026          *  Calculate how many bytes it is possible to transmit before the
1027          *  link must be turned around
1028          */
1029         self->line_capacity =
1030                 irlap_max_line_capacity(self->qos_tx.baud_rate.value,
1031                                         self->qos_tx.max_turn_time.value);
1032         self->bytes_left = self->line_capacity;
1033 #endif /* CONFIG_IRDA_DYNAMIC_WINDOW */
1034
1035
1036         /*
1037          *  Initialize timeout values, some of the rules are listed on
1038          *  page 92 in IrLAP.
1039          */
1040         IRDA_ASSERT(self->qos_tx.max_turn_time.value != 0, return;);
1041         IRDA_ASSERT(self->qos_rx.max_turn_time.value != 0, return;);
1042         /* The poll timeout applies only to the primary station.
1043          * It defines the maximum time the primary stay in XMIT mode
1044          * before timeout and turning the link around (sending a RR).
1045          * Or, this is how much we can keep the pf bit in primary mode.
1046          * Therefore, it must be lower or equal than our *OWN* max turn around.
1047          * Jean II */
1048         self->poll_timeout = self->qos_tx.max_turn_time.value * HZ / 1000;
1049         /* The Final timeout applies only to the primary station.
1050          * It defines the maximum time the primary wait (mostly in RECV mode)
1051          * for an answer from the secondary station before polling it again.
1052          * Therefore, it must be greater or equal than our *PARTNER*
1053          * max turn around time - Jean II */
1054         self->final_timeout = self->qos_rx.max_turn_time.value * HZ / 1000;
1055         /* The Watchdog Bit timeout applies only to the secondary station.
1056          * It defines the maximum time the secondary wait (mostly in RECV mode)
1057          * for poll from the primary station before getting annoyed.
1058          * Therefore, it must be greater or equal than our *PARTNER*
1059          * max turn around time - Jean II */
1060         self->wd_timeout = self->final_timeout * 2;
1061
1062         /*
1063          * N1 and N2 are maximum retry count for *both* the final timer
1064          * and the wd timer (with a factor 2) as defined above.
1065          * After N1 retry of a timer, we give a warning to the user.
1066          * After N2 retry, we consider the link dead and disconnect it.
1067          * Jean II
1068          */
1069
1070         /*
1071          *  Set N1 to 0 if Link Disconnect/Threshold Time = 3 and set it to
1072          *  3 seconds otherwise. See page 71 in IrLAP for more details.
1073          *  Actually, it's not always 3 seconds, as we allow to set
1074          *  it via sysctl... Max maxtt is 500ms, and N1 need to be multiple
1075          *  of 2, so 1 second is minimum we can allow. - Jean II
1076          */
1077         if (self->qos_tx.link_disc_time.value == sysctl_warn_noreply_time)
1078                 /*
1079                  * If we set N1 to 0, it will trigger immediately, which is
1080                  * not what we want. What we really want is to disable it,
1081                  * Jean II
1082                  */
1083                 self->N1 = -2; /* Disable - Need to be multiple of 2*/
1084         else
1085                 self->N1 = sysctl_warn_noreply_time * 1000 /
1086                   self->qos_rx.max_turn_time.value;
1087
1088         IRDA_DEBUG(4, "Setting N1 = %d\n", self->N1);
1089
1090         /* Set N2 to match our own disconnect time */
1091         self->N2 = self->qos_tx.link_disc_time.value * 1000 /
1092                 self->qos_rx.max_turn_time.value;
1093         IRDA_DEBUG(4, "Setting N2 = %d\n", self->N2);
1094 }
1095
1096 #ifdef CONFIG_PROC_FS
1097 struct irlap_iter_state {
1098         int id;
1099 };
1100
1101 static void *irlap_seq_start(struct seq_file *seq, loff_t *pos)
1102 {
1103         struct irlap_iter_state *iter = seq->private;
1104         struct irlap_cb *self;
1105
1106         /* Protect our access to the tsap list */
1107         spin_lock_irq(&irlap->hb_spinlock);
1108         iter->id = 0;
1109
1110         for (self = (struct irlap_cb *) hashbin_get_first(irlap);
1111              self; self = (struct irlap_cb *) hashbin_get_next(irlap)) {
1112                 if (iter->id == *pos)
1113                         break;
1114                 ++iter->id;
1115         }
1116
1117         return self;
1118 }
1119
1120 static void *irlap_seq_next(struct seq_file *seq, void *v, loff_t *pos)
1121 {
1122         struct irlap_iter_state *iter = seq->private;
1123
1124         ++*pos;
1125         ++iter->id;
1126         return (void *) hashbin_get_next(irlap);
1127 }
1128
1129 static void irlap_seq_stop(struct seq_file *seq, void *v)
1130 {
1131         spin_unlock_irq(&irlap->hb_spinlock);
1132 }
1133
1134 static int irlap_seq_show(struct seq_file *seq, void *v)
1135 {
1136         const struct irlap_iter_state *iter = seq->private;
1137         const struct irlap_cb *self = v;
1138
1139         IRDA_ASSERT(self->magic == LAP_MAGIC, return -EINVAL;);
1140
1141         seq_printf(seq, "irlap%d ", iter->id);
1142         seq_printf(seq, "state: %s\n",
1143                    irlap_state[self->state]);
1144
1145         seq_printf(seq, "  device name: %s, ",
1146                    (self->netdev) ? self->netdev->name : "bug");
1147         seq_printf(seq, "hardware name: %s\n", self->hw_name);
1148
1149         seq_printf(seq, "  caddr: %#02x, ", self->caddr);
1150         seq_printf(seq, "saddr: %#08x, ", self->saddr);
1151         seq_printf(seq, "daddr: %#08x\n", self->daddr);
1152
1153         seq_printf(seq, "  win size: %d, ",
1154                    self->window_size);
1155         seq_printf(seq, "win: %d, ", self->window);
1156 #ifdef CONFIG_IRDA_DYNAMIC_WINDOW
1157         seq_printf(seq, "line capacity: %d, ",
1158                    self->line_capacity);
1159         seq_printf(seq, "bytes left: %d\n", self->bytes_left);
1160 #endif /* CONFIG_IRDA_DYNAMIC_WINDOW */
1161         seq_printf(seq, "  tx queue len: %d ",
1162                    skb_queue_len(&self->txq));
1163         seq_printf(seq, "win queue len: %d ",
1164                    skb_queue_len(&self->wx_list));
1165         seq_printf(seq, "rbusy: %s", self->remote_busy ?
1166                    "TRUE" : "FALSE");
1167         seq_printf(seq, " mbusy: %s\n", self->media_busy ?
1168                    "TRUE" : "FALSE");
1169
1170         seq_printf(seq, "  retrans: %d ", self->retry_count);
1171         seq_printf(seq, "vs: %d ", self->vs);
1172         seq_printf(seq, "vr: %d ", self->vr);
1173         seq_printf(seq, "va: %d\n", self->va);
1174
1175         seq_printf(seq, "  qos\tbps\tmaxtt\tdsize\twinsize\taddbofs\tmintt\tldisc\tcomp\n");
1176
1177         seq_printf(seq, "  tx\t%d\t",
1178                    self->qos_tx.baud_rate.value);
1179         seq_printf(seq, "%d\t",
1180                    self->qos_tx.max_turn_time.value);
1181         seq_printf(seq, "%d\t",
1182                    self->qos_tx.data_size.value);
1183         seq_printf(seq, "%d\t",
1184                    self->qos_tx.window_size.value);
1185         seq_printf(seq, "%d\t",
1186                    self->qos_tx.additional_bofs.value);
1187         seq_printf(seq, "%d\t",
1188                    self->qos_tx.min_turn_time.value);
1189         seq_printf(seq, "%d\t",
1190                    self->qos_tx.link_disc_time.value);
1191         seq_printf(seq, "\n");
1192
1193         seq_printf(seq, "  rx\t%d\t",
1194                    self->qos_rx.baud_rate.value);
1195         seq_printf(seq, "%d\t",
1196                    self->qos_rx.max_turn_time.value);
1197         seq_printf(seq, "%d\t",
1198                    self->qos_rx.data_size.value);
1199         seq_printf(seq, "%d\t",
1200                    self->qos_rx.window_size.value);
1201         seq_printf(seq, "%d\t",
1202                    self->qos_rx.additional_bofs.value);
1203         seq_printf(seq, "%d\t",
1204                    self->qos_rx.min_turn_time.value);
1205         seq_printf(seq, "%d\n",
1206                    self->qos_rx.link_disc_time.value);
1207
1208         return 0;
1209 }
1210
1211 static const struct seq_operations irlap_seq_ops = {
1212         .start  = irlap_seq_start,
1213         .next   = irlap_seq_next,
1214         .stop   = irlap_seq_stop,
1215         .show   = irlap_seq_show,
1216 };
1217
1218 static int irlap_seq_open(struct inode *inode, struct file *file)
1219 {
1220         if (irlap == NULL)
1221                 return -EINVAL;
1222
1223         return seq_open_private(file, &irlap_seq_ops,
1224                         sizeof(struct irlap_iter_state));
1225 }
1226
1227 const struct file_operations irlap_seq_fops = {
1228         .owner          = THIS_MODULE,
1229         .open           = irlap_seq_open,
1230         .read           = seq_read,
1231         .llseek         = seq_lseek,
1232         .release        = seq_release_private,
1233 };
1234
1235 #endif /* CONFIG_PROC_FS */