net/cor/common.c

   1 /*
   2  *      Connection oriented routing
   3  *      Copyright (C) 2007-2010 Michael Blizek
   4  *
   5  *      This program is free software; you can redistribute it and/or
   6  *      modify it under the terms of the GNU General Public License
   7  *      as published by the Free Software Foundation; either version 2
   8  *      of the License, or (at your option) any later version.
   9  *
  10  *      This program is distributed in the hope that it will be useful,
  11  *      but WITHOUT ANY WARRANTY; without even the implied warranty of
  12  *      MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  13  *      GNU General Public License for more details.
  14  *
  15  *      You should have received a copy of the GNU General Public License
  16  *      along with this program; if not, write to the Free Software
  17  *      Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
  18  *      02110-1301, USA.
  19  */
  20
  21 #include <linux/mutex.h>
  22
  23 #include "cor.h"
  24
  25 DEFINE_MUTEX(cor_bindnodes);
  26 DEFINE_SPINLOCK(conn_free);
  27
  28 DEFINE_MUTEX(connid_gen);
  29
  30 LIST_HEAD(openports);
  31
  32
  33 struct cell_hdr{
  34         spinlock_t lock;
  35 };
  36
  37
  38
  39 struct kmem_cache *conn_slab;
  40
  41 struct htable connid_table;
  42 struct htable reverse_connid_table;
  43
  44 atomic_t num_conns;
  45
  46 struct kmem_cache *bindnode_slab;
  47 struct kmem_cache *connlistener_slab;
  48
  49 /* see cor.h/KP_ACK_CONN */
  50 static const __u32 log_64_11_table[] = {0,
  51                 64, 68, 73, 77, 82, 88, 93, 99, 106, 113, 120,
  52                 128, 136, 145, 155, 165, 175, 187, 199, 212, 226, 240,
  53                 256, 273, 290, 309, 329, 351, 374, 398, 424, 451, 481,
  54                 512, 545, 581, 619, 659, 702, 747, 796, 848, 903, 961,
  55                 1024, 1091, 1162, 1237, 1318, 1403, 1495, 1592, 1695, 1805,
  56                                 1923,
  57                 2048, 2181, 2323, 2474, 2635, 2806, 2989, 3183, 3390, 3611,
  58                                 3846,
  59                 4096, 4362, 4646, 4948, 5270, 5613, 5978, 6367, 6781, 7222,
  60                                 7692,
  61                 8192, 8725, 9292, 9897, 10540, 11226, 11956, 12734, 13562,
  62                                 14444, 15383,
  63                 16384, 17450, 18585, 19793, 21081, 22452, 23912, 25467, 27124,
  64                                 28888, 30767,
  65                 32768, 34899, 37169, 39587, 42161, 44904, 47824, 50935, 54248,
  66                                 57776, 61534,
  67                 65536, 69799, 74338, 79173, 84323, 89807, 95648, 101870, 108495,
  68                                 115552, 123068,
  69                 131072, 139597, 148677, 158347, 168646, 179615, 191297, 203739,
  70                                 216991, 231104, 246135,
  71                 262144, 279194, 297353, 316693, 337291, 359229, 382594, 407478,
  72                                 433981, 462208, 492270,
  73                 524288, 558388, 594706, 633387, 674583, 718459, 765188, 814957,
  74                                 867962, 924415, 984540,
  75                 1048576, 1116777, 1189413, 1266774, 1349166, 1436917, 1530376,
  76                                 1629913, 1735924, 1848831, 1969081,
  77                 2097152, 2233553, 2378826, 2533547, 2698332, 2873834, 3060752,
  78                                 3259826, 3471849, 3697662, 3938162,
  79                 4194304, 4467106, 4757652, 5067094, 5396664, 5747669, 6121503,
  80                                 6519652, 6943698, 7395323, 7876323,
  81                 8388608, 8934212, 9515303, 10134189, 10793327, 11495337,
  82                                 12243006, 13039305, 13887396, 14790647,
  83                                 15752647,
  84                 16777216, 17868424, 19030606, 20268378, 21586655, 22990674,
  85                                 24486013, 26078610, 27774791, 29581294,
  86                                 31505293,
  87                 33554432, 35736849, 38061212, 40536755, 43173310, 45981349,
  88                                 48972026, 52157220, 55549582, 59162588,
  89                                 63010587,
  90                 67108864, 71473698, 76122425, 81073510, 86346620, 91962698,
  91                                 97944052, 104314440, 111099165, 118325175,
  92                                 126021174,
  93                 134217728, 142947395, 152244850, 162147020, 172693239,
  94                                 183925396, 195888104, 208628880, 222198329,
  95                                 236650351, 252042347,
  96                 268435456, 285894791, 304489699, 324294041, 345386479,
  97                                 367850791, 391776208, 417257759, 444396658,
  98                                 473300701, 504084694,
  99                 536870912, 571789581};
 100
 101 __u8 enc_log_64_11(__u32 value)
 102 {
 103         int i;
 104         BUG_ON(log_64_11_table[255] != 571789581);
 105         for (i=1;i<256;i++) {
 106                 if (log_64_11_table[i] > value)
 107                         break;
 108         }
 109
 110         return (__u8)(i-1); /* round down */
 111 }
 112
 113 __u32 dec_log_64_11(__u8 value)
 114 {
 115         BUG_ON(log_64_11_table[255] != 571789581);
 116         return log_64_11_table[value];
 117 }
 118
 119 static inline __u64 mul_saturated(__u64 a, __u64 b)
 120 {
 121         __u64 res = a*b;
 122         if (unlikely(res / a != b))
 123                 return -1;
 124         return res;
 125 }
 126
 127 static inline int numdigits(__u64 value)
 128 {
 129         int digits = 0;
 130         for (;value != 0;value = (value >> 1)) {
 131                 digits++;
 132         }
 133         return digits;
 134 }
 135
 136 /* approximate (a*b) / c without overflowing a*b */
 137 __u64 multiply_div(__u64 a, __u64 b, __u64 c)
 138 {
 139         int alen = numdigits(a);
 140         int blen = numdigits(b);
 141         int clen = numdigits(c);
 142
 143         BUG_ON(alen < 0 || alen > 64);
 144         BUG_ON(blen < 0 || blen > 64);
 145         BUG_ON(clen < 0 || clen > 64);
 146
 147         BUG_ON((a == 0 && alen != 0) || (a != 0 && alen == 0));
 148         BUG_ON((b == 0 && blen != 0) || (b != 0 && blen == 0));
 149         BUG_ON((c == 0 && clen != 0) || (c != 0 && clen == 0));
 150
 151         BUG_ON(a >= b && alen < blen);
 152         BUG_ON(a >= c && alen < clen);
 153         BUG_ON(b >= a && blen < alen);
 154         BUG_ON(b >= c && blen < clen);
 155         BUG_ON(c >= a && clen < alen);
 156         BUG_ON(c >= b && clen < blen);
 157
 158         if (alen == 0 || blen == 0)
 159                 return 0;
 160
 161         BUG_ON(c == 0);
 162
 163         if (alen + blen <= 64)
 164                 return (a*b)/c;
 165
 166         if (a >= b && alen > clen + 16)
 167                 return mul_saturated(a/c, b);
 168         else if (a < b && blen > clen + 16)
 169                 return mul_saturated(b/c, a);
 170
 171         while (alen + blen > 64) {
 172                 if (alen > blen || (alen == blen && a > b)) {
 173                         alen--;
 174                         a = (a >> 1);
 175                 } else {
 176                         blen--;
 177                         b = (b >> 1);
 178                 }
 179                 clen--;
 180                 c = (c >> 1);
 181         }
 182
 183         return (a*b)/c;
 184 }
 185
 186 static inline int hdr_size(void)
 187 {
 188         return ((sizeof(struct cell_hdr) + sizeof(void *) - 1) / sizeof(void *)
 189                 ) * sizeof(void *);
 190 }
 191
 192 static inline int elements_per_cell(int cell_size)
 193 {
 194         return (cell_size - hdr_size())/sizeof(void *);
 195 }
 196
 197 static inline struct cell_hdr *cell_addr(struct htable *ht, __u32 id)
 198 {
 199         int idx = (id%ht->htable_size) / (elements_per_cell(ht->cell_size));
 200         return (struct cell_hdr *) (((char *)ht->htable) + ht->cell_size * idx);
 201 }
 202
 203 static inline char **element_addr(struct htable *ht, __u32 id)
 204 {
 205         int idx = (id%ht->htable_size) % (elements_per_cell(ht->cell_size));
 206         return (char **)
 207                         ( ((char *)cell_addr(ht, id)) +
 208                         hdr_size() + idx*sizeof(void *) );
 209 }
 210
 211
 212 static inline char **next_element(struct htable *ht, char *element)
 213 {
 214         return (char **)(element + ht->entry_offset);
 215 }
 216
 217 static inline struct kref *element_kref(struct htable *ht, char *element)
 218 {
 219         return (struct kref *)(element + ht->kref_offset);
 220 }
 221
 222
 223 static inline void unlock_element(struct htable *ht, __u32 key)
 224 {
 225         struct cell_hdr *hdr = cell_addr(ht, key);
 226         spin_unlock( &(hdr->lock) );
 227 }
 228
 229
 230 static char **get_element_nounlock(struct htable *ht, __u32 key,
 231                 void *searcheditem)
 232 {
 233         struct cell_hdr *hdr = cell_addr(ht, key);
 234         char **element = element_addr(ht, key);
 235
 236         BUG_ON(0 == element);
 237
 238         spin_lock( &(hdr->lock) );
 239
 240         while (1) {
 241                 if (*element == 0)
 242                         break;
 243                 if (searcheditem != 0 && ht->matches(*element, searcheditem))
 244                         break;
 245                 element = next_element(ht, *element);
 246         }
 247
 248         return element;
 249 }
 250
 251 char *htable_get(struct htable *ht, __u32 key, void *searcheditem)
 252 {
 253         unsigned long iflags;
 254         char *element;
 255
 256         if (unlikely(ht->htable == 0))
 257                 return 0;
 258
 259         local_irq_save(iflags);
 260         element = *(get_element_nounlock(ht, key, searcheditem));
 261         if (likely(element != 0))
 262                 kref_get(element_kref(ht, element));
 263         unlock_element(ht, key);
 264         local_irq_restore(iflags);
 265
 266         return element;
 267 }
 268
 269 int htable_delete(struct htable *ht, __u32 key,
 270                 void *searcheditem, void (*free) (struct kref *ref))
 271 {
 272         unsigned long iflags;
 273         char **element;
 274         char **next;
 275         int rc = 0;
 276
 277         if (unlikely(ht->htable == 0))
 278                 return 1;
 279
 280         local_irq_save(iflags);
 281
 282         element = get_element_nounlock(ht, key, searcheditem);
 283         BUG_ON(0 == element);
 284
 285         if (unlikely(*element == 0)) {
 286                 /* key not in table */
 287                 rc = 1;
 288                 goto out;
 289         }
 290
 291         next = next_element(ht, *element);
 292         kref_put(element_kref(ht, *element), free);
 293         *element = *next;
 294
 295 out:
 296         unlock_element(ht, key);
 297         local_irq_restore(iflags);
 298
 299         return rc;
 300 }
 301
 302 void htable_insert(struct htable *ht, char *newelement, __u32 key)
 303 {
 304         unsigned long iflags;
 305         char **element;
 306
 307         if (unlikely(ht->htable == 0))
 308                 return;
 309
 310         BUG_ON(*next_element(ht, newelement) != 0);
 311         local_irq_save(iflags);
 312
 313         element = get_element_nounlock(ht, key, 0);
 314
 315         BUG_ON(element == 0);
 316         BUG_ON(*element != 0);
 317
 318         *element = newelement;
 319         kref_get(element_kref(ht, newelement));
 320
 321         unlock_element(ht, key);
 322         local_irq_restore(iflags);
 323 }
 324
 325
 326 void htable_init(struct htable *ht, int (*matches)(void *htentry,
 327                 void *searcheditem), __u32 entry_offset, __u32 kref_offset)
 328 {
 329         int num_cells;
 330         int j;
 331
 332         BUG_ON(0 == ht);
 333
 334         ht->htable = kmalloc(PAGE_SIZE, GFP_KERNEL);
 335         if (unlikely(ht->htable == 0)) {
 336                 printk(KERN_CRIT "cor: error allocating htable (out of "
 337                                 "memory?)");
 338                 return;
 339         }
 340         memset(ht->htable, 0, PAGE_SIZE);
 341         ht->cell_size = 256;
 342
 343         num_cells = PAGE_SIZE/ht->cell_size;
 344
 345         for (j=0;j<num_cells;j++) {
 346                 struct cell_hdr *hdr = (struct cell_hdr *)
 347                                 ( ((char *) ht->htable) + j * ht->cell_size );
 348                 spin_lock_init(&(hdr->lock));
 349         }
 350
 351         ht->htable_size = num_cells * elements_per_cell(ht->cell_size);
 352         ht->num_elements = 0;
 353
 354         ht->matches = matches;
 355         ht->entry_offset = entry_offset;
 356         ht->kref_offset = kref_offset;
 357 }
 358
 359 struct reverse_connid_matchparam {
 360         struct neighbor *nb;
 361         __u32 conn_id;
 362 };
 363
 364 static __u32 rcm_to_key(struct reverse_connid_matchparam *rcm)
 365 {
 366         return (((__u32) rcm->nb) ^ rcm->conn_id);
 367 }
 368
 369 static int matches_reverse_connid(void *htentry, void *searcheditem)
 370 {
 371         struct conn *conn = (struct conn *) htentry;
 372         struct reverse_connid_matchparam *rcm =
 373                         (struct reverse_connid_matchparam *)  searcheditem;
 374         BUG_ON(conn->targettype != TARGET_OUT);
 375         return (conn->target.out.nb == rcm->nb) &&
 376                         (conn->target.out.conn_id == rcm->conn_id);
 377 }
 378
 379 struct conn *get_conn_reverse(struct neighbor *nb, __u32 conn_id)
 380 {
 381         struct reverse_connid_matchparam rcm;
 382         rcm.nb = nb;
 383         rcm.conn_id = conn_id;
 384
 385         return (struct conn *) htable_get(&reverse_connid_table,
 386                         rcm_to_key(&rcm), &rcm);
 387 }
 388
 389 void insert_reverse_connid(struct conn *rconn)
 390 {
 391         struct reverse_connid_matchparam rcm;
 392
 393         BUG_ON(rconn->targettype != TARGET_OUT);
 394
 395         rcm.nb = rconn->target.out.nb;
 396         rcm.conn_id = rconn->target.out.conn_id;
 397         htable_insert(&reverse_connid_table, (char *) rconn, rcm_to_key(&rcm));
 398 }
 399
 400 struct conn *get_conn(__u32 conn_id)
 401 {
 402         return (struct conn *) htable_get(&connid_table, conn_id, &conn_id);
 403 }
 404
 405 static int connid_alloc(struct conn *sconn)
 406 {
 407         __u32 conn_id;
 408         int i;
 409
 410         BUG_ON(sconn->sourcetype != SOURCE_IN);
 411
 412         mutex_lock(&connid_gen);
 413         for(i=0;i<16;i++) {
 414                 struct conn *tmp;
 415
 416                 conn_id = 0;
 417                 get_random_bytes((char *) &conn_id, sizeof(conn_id));
 418
 419                 if (unlikely(conn_id == 0))
 420                         continue;
 421
 422                 tmp = get_conn(conn_id);
 423                 if (unlikely(tmp != 0)) {
 424                         kref_put(&(tmp->ref), free_conn);
 425                         continue;
 426                 }
 427
 428                 goto found;
 429         }
 430         mutex_unlock(&connid_gen);
 431
 432         return 1;
 433
 434 found:
 435         sconn->source.in.conn_id = conn_id;
 436         htable_insert(&connid_table, (char *) sconn, conn_id);
 437         mutex_unlock(&connid_gen);
 438         return 0;
 439 }
 440
 441 void free_conn(struct kref *ref)
 442 {
 443         unsigned long iflags;
 444         struct conn *conn = container_of(ref, struct conn, ref);
 445         struct conn *reversedir = 0;
 446
 447         BUG_ON(atomic_read(&(conn->isreset)) == 0);
 448
 449         spin_lock_irqsave(&conn_free, iflags);
 450
 451         if (conn->reversedir != 0)
 452                 atomic_set(&(conn->reversedir->isreset), 3);
 453
 454         if (atomic_read(&(conn->isreset)) != 3)
 455                 goto out;
 456
 457         if (conn->reversedir != 0) {
 458                 conn->reversedir->reversedir = 0;
 459                 reversedir = conn->reversedir;
 460                 conn->reversedir = 0;
 461         }
 462
 463         if (conn->sourcetype == SOURCE_IN) {
 464                 kref_put(&(conn->source.in.nb->ref), neighbor_free);
 465                 conn->source.in.nb = 0;
 466         }
 467
 468         if (conn->targettype == TARGET_OUT) {
 469                 kref_put(&(conn->target.out.nb->ref), neighbor_free);
 470                 conn->target.out.nb = 0;
 471         }
 472
 473         BUG_ON(conn->data_buf.totalsize != 0);
 474         BUG_ON(conn->data_buf.overhead != 0);
 475
 476         kmem_cache_free(conn_slab, conn);
 477
 478 out:
 479         spin_unlock_irqrestore(&conn_free, iflags);
 480
 481         if (reversedir != 0)
 482                 free_conn(&(reversedir->ref));
 483 }
 484
 485 /*
 486  * rconn ==> the connection we received the commend from
 487  * ==> init rconn->target.out + rconn->reversedir->source.in
 488  * rc == 0 ==> ok
 489  * rc == 1 ==> connid allocation failed
 490  *
 491  * NOTE: call to this func *must* be protected by rcv_lock
 492  */
 493 int conn_init_out(struct conn *rconn, struct neighbor *nb)
 494 {
 495         int rc = 0;
 496         struct conn *sconn = rconn->reversedir;
 497
 498         mutex_lock(&(sconn->rcv_lock));
 499
 500         BUG_ON(rconn->targettype != TARGET_UNCONNECTED);
 501         BUG_ON(sconn == 0);
 502         BUG_ON(sconn->sourcetype != SOURCE_NONE);
 503
 504         memset(&(rconn->target.out), 0, sizeof(rconn->target.out));
 505         memset(&(sconn->source.in), 0, sizeof(sconn->source.in));
 506
 507         rconn->targettype = TARGET_OUT;
 508         sconn->sourcetype = SOURCE_IN;
 509
 510         rconn->target.out.nb = nb;
 511         sconn->source.in.nb = nb;
 512
 513         /* neighbor pointer */
 514         kref_get(&(nb->ref));
 515         kref_get(&(nb->ref));
 516
 517         skb_queue_head_init(&(sconn->source.in.reorder_queue));
 518         atomic_set(&(sconn->source.in.pong_awaiting), 0);
 519
 520         if (unlikely(connid_alloc(sconn))) {
 521                 rc = 1;
 522                 goto out;
 523         }
 524
 525         INIT_LIST_HEAD(&(rconn->target.out.retrans_list));
 526
 527         reset_seqno(rconn, 0);
 528         get_random_bytes((char *) &(sconn->source.in.next_seqno),
 529                         sizeof(sconn->source.in.next_seqno));
 530
 531         mutex_lock(&(nb->conn_list_lock));
 532         list_add_tail(&(sconn->source.in.nb_list), &(nb->rcv_conn_list));
 533         list_add_tail(&(rconn->target.out.nb_list), &(nb->snd_conn_list));
 534         nb->num_send_conns++;
 535         mutex_unlock(&(nb->conn_list_lock));
 536
 537         /* neighbor lists */
 538         kref_get(&(rconn->ref));
 539         kref_get(&(sconn->ref));
 540
 541         atomic_inc(&num_conns);
 542
 543 out:
 544         mutex_unlock(&(sconn->rcv_lock));
 545
 546         #warning todo initial send credits
 547
 548         return rc;
 549 }
 550
 551 void conn_init_sock_source(struct conn *conn)
 552 {
 553         BUG_ON(conn == 0);
 554         conn->sourcetype = SOURCE_SOCK;
 555         memset(&(conn->source.sock), 0, sizeof(conn->source.sock));
 556         init_waitqueue_head(&(conn->source.sock.wait));
 557 }
 558
 559 void conn_init_sock_target(struct conn *conn)
 560 {
 561         BUG_ON(conn == 0);
 562         conn->targettype = TARGET_SOCK;
 563         memset(&(conn->target.sock), 0, sizeof(conn->target.sock));
 564         init_waitqueue_head(&(conn->target.sock.wait));
 565         reset_seqno(conn, 0);
 566 }
 567
 568 struct conn* alloc_conn(gfp_t allocflags)
 569 {
 570         struct conn *rconn = 0;
 571         struct conn *sconn = 0;
 572
 573         rconn = kmem_cache_alloc(conn_slab, allocflags);
 574         if (unlikely(rconn == 0))
 575                 goto out_err0;
 576
 577         sconn = kmem_cache_alloc(conn_slab, allocflags);
 578         if (unlikely(sconn == 0))
 579                 goto out_err1;
 580
 581         memset(rconn, 0, sizeof(struct conn));
 582         memset(sconn, 0, sizeof(struct conn));
 583
 584         rconn->reversedir = sconn;
 585         sconn->reversedir = rconn;
 586
 587         kref_init(&(rconn->ref));
 588         kref_init(&(sconn->ref));
 589
 590         rconn->sockstate = SOCKSTATE_CONN;
 591         sconn->sockstate = SOCKSTATE_CONN;
 592
 593         rconn->sourcetype = SOURCE_NONE;
 594         sconn->sourcetype = SOURCE_NONE;
 595         rconn->targettype = TARGET_UNCONNECTED;
 596         sconn->targettype = TARGET_UNCONNECTED;
 597
 598         atomic_set(&(rconn->isreset), 0);
 599         atomic_set(&(sconn->isreset), 0);
 600
 601         mutex_init(&(rconn->rcv_lock));
 602         mutex_init(&(sconn->rcv_lock));
 603
 604         rconn->jiffies_credit_update = jiffies;
 605         rconn->jiffies_credit_update = rconn->jiffies_credit_update;
 606
 607         rconn->crate_forward = ((1 << 31) - (((__u32) 1 << 31) / 10));
 608         sconn->crate_forward = ((1 << 31) - (((__u32) 1 << 31) / 10));
 609
 610         databuf_init(rconn);
 611         databuf_init(sconn);
 612
 613         return rconn;
 614
 615 out_err1:
 616         kmem_cache_free(conn_slab, rconn);
 617 out_err0:
 618         return 0;
 619 }
 620
 621 static struct connlistener *get_connlistener(__be64 port)
 622 {
 623         struct list_head *curr = openports.next;
 624
 625         while (curr != &openports) {
 626                 struct bindnode *currnode = ((struct bindnode *)
 627                         (((char *)curr) - offsetof(struct bindnode, lh)));
 628                 if (currnode->port == port) {
 629                         BUG_ON(currnode->owner == 0);
 630                         return currnode->owner;
 631                 }
 632
 633                 curr = curr->next;
 634         }
 635
 636         return 0;
 637 }
 638
 639 void close_port(struct connlistener *listener)
 640 {
 641         mutex_lock(&cor_bindnodes);
 642
 643         if (listener->bn != 0) {
 644                 list_del(&(listener->bn->lh));
 645                 kmem_cache_free(bindnode_slab, listener->bn);
 646                 listener->bn = 0;
 647         }
 648
 649         while (list_empty(&(listener->conn_queue)) == 0) {
 650                 struct conn *rconn = container_of(listener->conn_queue.next,
 651                                 struct conn, source.sock.cl_list);
 652                 list_del(&(rconn->source.sock.cl_list));
 653                 atomic_cmpxchg(&(rconn->reversedir->isreset), 0, 1);
 654                 reset_conn(rconn);
 655                 kref_put(&(rconn->ref), free_conn);
 656         }
 657
 658         kmem_cache_free(connlistener_slab, listener);
 659
 660         mutex_unlock(&cor_bindnodes);
 661 }
 662
 663 struct connlistener *open_port(__be64 port)
 664 {
 665
 666         struct bindnode *bn = 0;
 667         struct connlistener *listener = 0;
 668
 669         mutex_lock(&cor_bindnodes);
 670         if (get_connlistener(port) != 0)
 671                 goto out;
 672
 673
 674         bn = kmem_cache_alloc(bindnode_slab, GFP_KERNEL);
 675         listener = kmem_cache_alloc(connlistener_slab, GFP_KERNEL);
 676
 677         memset(bn, 0, sizeof(struct bindnode));
 678         memset(listener, 0, sizeof(struct connlistener));
 679
 680         bn->owner = listener;
 681         bn->port = port;
 682
 683         /* kref is not actually used */
 684         listener->sockstate = SOCKSTATE_LISTENER;
 685         listener->bn = bn;
 686         mutex_init(&(listener->lock));
 687         INIT_LIST_HEAD(&(listener->conn_queue));
 688         init_waitqueue_head(&(listener->wait));
 689
 690         list_add_tail((struct list_head *) &(bn->lh), &openports);
 691
 692 out:
 693         mutex_unlock(&cor_bindnodes);
 694
 695         return listener;
 696 }
 697
 698 /**
 699  * rc == 0 connected
 700  * rc == 2 port not open
 701  * rc == 3 listener queue full
 702  */
 703 int connect_port(struct conn *rconn, __be64 port)
 704 {
 705
 706         struct connlistener *listener;
 707         int rc = 0;
 708
 709         mutex_lock(&cor_bindnodes);
 710
 711         listener = get_connlistener(port);
 712         if (listener == 0) {
 713                 rc = 2;
 714                 goto out;
 715         }
 716
 717         mutex_lock(&(listener->lock));
 718
 719         if (unlikely(listener->queue_len >= listener->queue_maxlen)) {
 720                 if (listener->queue_maxlen <= 0)
 721                         rc = 2;
 722                 else
 723                         rc = 3;
 724
 725                 goto out2;
 726         }
 727
 728         kref_get(&(rconn->reversedir->ref));
 729
 730         mutex_lock(&(rconn->reversedir->rcv_lock));
 731         conn_init_sock_target(rconn);
 732         conn_init_sock_source(rconn->reversedir);
 733         mutex_unlock(&(rconn->reversedir->rcv_lock));
 734
 735         list_add_tail(&(rconn->reversedir->source.sock.cl_list),
 736                         &(listener->conn_queue));
 737         listener->queue_len++;
 738         wake_up_interruptible(&(listener->wait));
 739
 740 out2:
 741         mutex_unlock(&(listener->lock));
 742
 743 out:
 744         mutex_unlock(&cor_bindnodes);
 745         return rc;
 746 }
 747
 748 /**
 749  * rc == 0 connected
 750  * rc == 2 addrtype not found
 751  * rc == 3 addr not found
 752  * rc == 4 ==> connid allocation failed
 753  * rc == 5 ==> control msg alloc failed
 754  */
 755 int connect_neigh(struct conn *rconn,
 756                 __u16 addrtypelen, __u8 *addrtype,
 757                 __u16 addrlen, __u8 *addr)
 758 {
 759         int rc = 0;
 760         struct control_msg_out *cm;
 761         struct neighbor *nb = find_neigh(addrtypelen, addrtype, addrlen, addr);
 762
 763         if (nb == 0)
 764                 return 3;
 765         if (unlikely(conn_init_out(rconn, nb))) {
 766                 rc = 4;
 767                 goto neigh_kref;
 768         }
 769
 770         cm = alloc_control_msg(nb, ACM_PRIORITY_HIGH);
 771         if (unlikely(cm == 0)) {
 772                 rc = 5;
 773                 goto neigh_kref;
 774         }
 775
 776         send_connect_nb(cm, rconn->reversedir->source.in.conn_id,
 777                         rconn->reversedir->source.in.next_seqno,
 778                         rconn->reversedir);
 779
 780 neigh_kref:
 781         kref_put(&(nb->ref), neighbor_free);
 782
 783         return rc;
 784 }
 785
 786 void reset_ping(struct conn *rconn)
 787 {
 788         struct neighbor *nb = rconn->source.in.nb;
 789         if (atomic_read(&(rconn->source.in.pong_awaiting)) != 0) {
 790                 mutex_lock(&(nb->conn_list_lock));
 791                 if (atomic_read(&(rconn->source.in.pong_awaiting)) == 0)
 792                         goto unlock;
 793
 794                 atomic_set(&(rconn->source.in.pong_awaiting), 0);
 795                 nb->pong_conns_expected--;
 796 unlock:
 797                 mutex_unlock(&(nb->conn_list_lock));
 798         }
 799 }
 800
 801 static int _reset_conn(struct conn *conn)
 802 {
 803         /*
 804          * aktive conns have an additional ref to make sure that they are not
 805          * freed when only one direction is referenced by the connid hashtable
 806          */
 807         int krefput = 1;
 808         int isreset = atomic_cmpxchg(&(conn->isreset), 0, 2);
 809         if (isreset == 1)
 810                 isreset = atomic_cmpxchg(&(conn->isreset), 1, 2);
 811
 812         if (isreset == 2 || isreset == 3)
 813                 return 0;
 814
 815         /* lock sourcetype/targettype */
 816         mutex_lock(&(conn->rcv_lock));
 817
 818         if (conn->sourcetype == SOURCE_IN) {
 819                 mutex_lock(&(conn->source.in.nb->conn_list_lock));
 820                 list_del(&(conn->source.in.nb_list));
 821                 mutex_unlock(&(conn->source.in.nb->conn_list_lock));
 822
 823                 krefput++;
 824
 825                 if (conn->source.in.conn_id != 0) {
 826                         if (htable_delete(&connid_table,
 827                                         conn->source.in.conn_id,
 828                                         &(conn->source.in.conn_id), free_conn)){
 829                                 printk(KERN_ERR "error in _reset_conn: "
 830                                                 "htable_delete src_in failed");
 831                         }
 832                         conn->source.in.conn_id = 0;
 833                 }
 834
 835                 reset_ping(conn);
 836
 837                 atomic_dec(&num_conns);
 838                 BUG_ON(atomic_read(&num_conns) < 0);
 839         } else if (conn->sourcetype == SOURCE_SOCK) {
 840                 wake_up_interruptible(&(conn->source.sock.wait));
 841         }
 842
 843         if (conn->targettype == TARGET_UNCONNECTED) {
 844                 connreset_cpacket_buffer(conn);
 845         } else if (conn->targettype == TARGET_OUT) {
 846                 mutex_lock(&(conn->target.out.nb->conn_list_lock));
 847                 list_del(&(conn->target.out.nb_list));
 848                 conn->target.out.nb->num_send_conns--;
 849                 BUG_ON(conn->target.out.nb->num_send_conns < 0);
 850                 mutex_unlock(&(conn->target.out.nb->conn_list_lock));
 851
 852                 krefput++;
 853
 854                 if (conn->target.out.conn_id != 0) {
 855                         struct reverse_connid_matchparam rcm;
 856                         rcm.nb = conn->target.out.nb;
 857                         rcm.conn_id = conn->target.out.conn_id;
 858                         if (htable_delete(&reverse_connid_table,
 859                                         rcm_to_key(&rcm),
 860                                         &rcm, free_conn)){
 861                                 printk(KERN_ERR "error in _reset_conn: "
 862                                                 "htable_delete target_out "
 863                                                 "failed");
 864                         }
 865                 }
 866
 867                 if (isreset == 0 && conn->target.out.conn_id != 0) {
 868                         struct control_msg_out *cm = alloc_control_msg(
 869                                         conn->target.out.nb, ACM_PRIORITY_HIGH);
 870                         if (unlikely(cm == 0))
 871                                 send_ping_all_conns(conn->target.out.nb);
 872                         else
 873                                 send_reset_conn(cm, conn->target.out.conn_id);
 874                 }
 875
 876                 conn->target.out.conn_id = 0;
 877
 878                 cancel_retrans(conn);
 879         } else if (conn->targettype == TARGET_SOCK) {
 880                 wake_up_interruptible(&(conn->target.sock.wait));
 881         }
 882
 883         databuf_free(conn);
 884
 885         mutex_unlock(&(conn->rcv_lock));
 886
 887         qos_remove_conn(conn);
 888         reset_bufferusage(conn);
 889         unreserve_sock_buffer(conn);
 890         connreset_credits(conn);
 891
 892         mutex_lock(&(conn->rcv_lock));
 893         if (conn->sourcetype != SOURCE_SOCK) {
 894                 mutex_unlock(&(conn->rcv_lock));
 895                 goto skipbufferlimits;
 896         }
 897         mutex_unlock(&(conn->rcv_lock));
 898
 899         mutex_lock(&sock_bufferlimits_lock);
 900         mutex_lock(&(conn->rcv_lock));
 901         if (conn->sourcetype == SOURCE_SOCK) {
 902                 BUG_ON(conn->source.sock.in_alwait_list);
 903                 conn->source.sock.sbt->usage -= conn->source.sock.alloclimit;
 904                 if (conn->source.sock.delay_flush) {
 905                         conn->source.sock.delay_flush = 0;
 906                         list_del(&(conn->source.sock.delflush_list));
 907                 }
 908                 kref_put(&(conn->source.sock.sbt->ref), free_sbt);
 909                 conn->source.sock.sbt = 0;
 910         }
 911         mutex_unlock(&(conn->rcv_lock));
 912         mutex_unlock(&sock_bufferlimits_lock);
 913
 914 skipbufferlimits:
 915         return krefput;
 916 }
 917
 918 /* warning: do not hold the rcv_lock while calling this! */
 919 void reset_conn(struct conn *conn)
 920 {
 921         int put1 = _reset_conn(conn);
 922         int put2 = _reset_conn(conn->reversedir);
 923
 924         /* free_conn may not be called, before both _reset_conn have finished */
 925         while (put1 > 0) {
 926                 kref_put(&(conn->ref), free_conn);
 927                 put1--;
 928         }
 929
 930         while (put2 > 0) {
 931                 kref_put(&(conn->reversedir->ref), free_conn);
 932                 put2--;
 933         }
 934 }
 935
 936 static int matches_connid_in(void *htentry, void *searcheditem)
 937 {
 938         struct conn *conn = (struct conn *) htentry;
 939         __u32 conn_id = *((__u32 *) searcheditem);
 940         BUG_ON(conn->sourcetype != SOURCE_IN);
 941         return (conn->source.in.conn_id == conn_id);
 942 }
 943
 944 static int __init cor_common_init(void)
 945 {
 946         int rc;
 947
 948         struct conn c;
 949
 950         printk(KERN_ERR "sizeof conn: %d", sizeof(c));
 951         printk(KERN_ERR "  conn.source: %d", sizeof(c.source));
 952         printk(KERN_ERR "  conn.target: %d", sizeof(c.target));
 953         printk(KERN_ERR "  conn.target.out: %d", sizeof(c.target.out));
 954         printk(KERN_ERR "  conn.buf: %d", sizeof(c.data_buf));
 955
 956         printk(KERN_ERR "  mutex: %d", sizeof(struct mutex));
 957         printk(KERN_ERR "  spinlock: %d", sizeof(spinlock_t));
 958         printk(KERN_ERR "  kref: %d", sizeof(struct kref));
 959
 960         conn_slab = kmem_cache_create("cor_conn", sizeof(struct conn), 8, 0, 0);
 961         htable_init(&connid_table, matches_connid_in,
 962                         offsetof(struct conn, source.in.htab_entry),
 963                         offsetof(struct conn, ref));
 964
 965         htable_init(&reverse_connid_table, matches_reverse_connid,
 966                         offsetof(struct conn, target.out.htab_entry),
 967                         offsetof(struct conn, ref));
 968
 969         bindnode_slab = kmem_cache_create("cor_bindnode",
 970                         sizeof(struct bindnode), 8, 0, 0);
 971         connlistener_slab = kmem_cache_create("cor_connlistener",
 972                         sizeof(struct connlistener), 8, 0, 0);
 973
 974         atomic_set(&num_conns, 0);
 975
 976         credits_init();
 977         forward_init();
 978         cor_kgen_init();
 979         cor_cpacket_init();
 980
 981         rc = cor_snd_init();
 982         if (unlikely(rc != 0))
 983                 return rc;
 984
 985         rc = cor_neighbor_init();
 986         if (unlikely(rc != 0))
 987                 return rc;
 988
 989         rc = cor_rcv_init();
 990         if (unlikely(rc != 0))
 991                 return rc;
 992
 993         return 0;
 994 }
 995
 996 module_init(cor_common_init);
 997 MODULE_LICENSE("GPL");