git.oblomov.eu Git - linux-2.6/blob - net/atm/mpoa_caches.c

   1 #include <linux/types.h>
   2 #include <linux/atmmpc.h>
   3 #include <linux/time.h>
   4
   5 #include "mpoa_caches.h"
   6 #include "mpc.h"
   7
   8 /*
   9  * mpoa_caches.c: Implementation of ingress and egress cache
  10  * handling functions
  11  */
  12
  13 #if 0
  14 #define dprintk printk    /* debug */
  15 #else
  16 #define dprintk(format,args...)
  17 #endif
  18
  19 #if 0
  20 #define ddprintk printk  /* more debug */
  21 #else
  22 #define ddprintk(format,args...)
  23 #endif
  24
  25 static in_cache_entry *in_cache_get(uint32_t dst_ip,
  26                                     struct mpoa_client *client)
  27 {
  28         in_cache_entry *entry;
  29
  30         read_lock_bh(&client->ingress_lock);
  31         entry = client->in_cache;
  32         while(entry != NULL){
  33                 if( entry->ctrl_info.in_dst_ip == dst_ip ){
  34                         atomic_inc(&entry->use);
  35                         read_unlock_bh(&client->ingress_lock);
  36                         return entry;
  37                 }
  38                 entry = entry->next;
  39         }
  40         read_unlock_bh(&client->ingress_lock);
  41
  42         return NULL;
  43 }
  44
  45 static in_cache_entry *in_cache_get_with_mask(uint32_t dst_ip,
  46                                               struct mpoa_client *client,
  47                                               uint32_t mask)
  48 {
  49         in_cache_entry *entry;
  50
  51         read_lock_bh(&client->ingress_lock);
  52         entry = client->in_cache;
  53         while(entry != NULL){
  54                 if((entry->ctrl_info.in_dst_ip & mask)  == (dst_ip & mask )){
  55                         atomic_inc(&entry->use);
  56                         read_unlock_bh(&client->ingress_lock);
  57                         return entry;
  58                 }
  59                 entry = entry->next;
  60         }
  61         read_unlock_bh(&client->ingress_lock);
  62
  63         return NULL;
  64
  65 }
  66
  67 static in_cache_entry *in_cache_get_by_vcc(struct atm_vcc *vcc,
  68                                            struct mpoa_client *client )
  69 {
  70         in_cache_entry *entry;
  71
  72         read_lock_bh(&client->ingress_lock);
  73         entry = client->in_cache;
  74         while(entry != NULL){
  75                 if(entry->shortcut == vcc) {
  76                         atomic_inc(&entry->use);
  77                         read_unlock_bh(&client->ingress_lock);
  78                         return entry;
  79                 }
  80                 entry = entry->next;
  81         }
  82         read_unlock_bh(&client->ingress_lock);
  83
  84         return NULL;
  85 }
  86
  87 static in_cache_entry *in_cache_add_entry(uint32_t dst_ip,
  88                                           struct mpoa_client *client)
  89 {
  90         unsigned char *ip __attribute__ ((unused)) = (unsigned char *)&dst_ip;
  91         in_cache_entry* entry = kmalloc(sizeof(in_cache_entry), GFP_KERNEL);
  92
  93         if (entry == NULL) {
  94                 printk("mpoa: mpoa_caches.c: new_in_cache_entry: out of memory\n");
  95                 return NULL;
  96         }
  97
  98         dprintk("mpoa: mpoa_caches.c: adding an ingress entry, ip = %u.%u.%u.%u\n", ip[0], ip[1], ip[2], ip[3]);
  99         memset(entry,0,sizeof(in_cache_entry));
 100
 101         atomic_set(&entry->use, 1);
 102         dprintk("mpoa: mpoa_caches.c: new_in_cache_entry: about to lock\n");
 103         write_lock_bh(&client->ingress_lock);
 104         entry->next = client->in_cache;
 105         entry->prev = NULL;
 106         if (client->in_cache != NULL)
 107                 client->in_cache->prev = entry;
 108         client->in_cache = entry;
 109
 110         memcpy(entry->MPS_ctrl_ATM_addr, client->mps_ctrl_addr, ATM_ESA_LEN);
 111         entry->ctrl_info.in_dst_ip = dst_ip;
 112         do_gettimeofday(&(entry->tv));
 113         entry->retry_time = client->parameters.mpc_p4;
 114         entry->count = 1;
 115         entry->entry_state = INGRESS_INVALID;
 116         entry->ctrl_info.holding_time = HOLDING_TIME_DEFAULT;
 117         atomic_inc(&entry->use);
 118
 119         write_unlock_bh(&client->ingress_lock);
 120         dprintk("mpoa: mpoa_caches.c: new_in_cache_entry: unlocked\n");
 121
 122         return entry;
 123 }
 124
 125 static int cache_hit(in_cache_entry *entry, struct mpoa_client *mpc)
 126 {
 127         struct atm_mpoa_qos *qos;
 128         struct k_message msg;
 129
 130         entry->count++;
 131         if(entry->entry_state == INGRESS_RESOLVED && entry->shortcut != NULL)
 132                 return OPEN;
 133
 134         if(entry->entry_state == INGRESS_REFRESHING){
 135                 if(entry->count > mpc->parameters.mpc_p1){
 136                         msg.type = SND_MPOA_RES_RQST;
 137                         msg.content.in_info = entry->ctrl_info;
 138                         memcpy(msg.MPS_ctrl, mpc->mps_ctrl_addr, ATM_ESA_LEN);
 139                         qos = atm_mpoa_search_qos(entry->ctrl_info.in_dst_ip);
 140                         if (qos != NULL) msg.qos = qos->qos;
 141                         msg_to_mpoad(&msg, mpc);
 142                         do_gettimeofday(&(entry->reply_wait));
 143                         entry->entry_state = INGRESS_RESOLVING;
 144                 }
 145                 if(entry->shortcut != NULL)
 146                         return OPEN;
 147                 return CLOSED;
 148         }
 149
 150         if(entry->entry_state == INGRESS_RESOLVING && entry->shortcut != NULL)
 151                 return OPEN;
 152
 153         if( entry->count > mpc->parameters.mpc_p1 &&
 154             entry->entry_state == INGRESS_INVALID){
 155                 unsigned char *ip __attribute__ ((unused)) =
 156                     (unsigned char *)&entry->ctrl_info.in_dst_ip;
 157
 158                 dprintk("mpoa: (%s) mpoa_caches.c: threshold exceeded for ip %u.%u.%u.%u, sending MPOA res req\n", mpc->dev->name, ip[0], ip[1], ip[2], ip[3]);
 159                 entry->entry_state = INGRESS_RESOLVING;
 160                 msg.type =  SND_MPOA_RES_RQST;
 161                 memcpy(msg.MPS_ctrl, mpc->mps_ctrl_addr, ATM_ESA_LEN );
 162                 msg.content.in_info = entry->ctrl_info;
 163                 qos = atm_mpoa_search_qos(entry->ctrl_info.in_dst_ip);
 164                 if (qos != NULL) msg.qos = qos->qos;
 165                 msg_to_mpoad( &msg, mpc);
 166                 do_gettimeofday(&(entry->reply_wait));
 167         }
 168
 169         return CLOSED;
 170 }
 171
 172 static void in_cache_put(in_cache_entry *entry)
 173 {
 174         if (atomic_dec_and_test(&entry->use)) {
 175                 memset(entry, 0, sizeof(in_cache_entry));
 176                 kfree(entry);
 177         }
 178
 179         return;
 180 }
 181
 182 /*
 183  * This should be called with write lock on
 184  */
 185 static void in_cache_remove_entry(in_cache_entry *entry,
 186                                   struct mpoa_client *client)
 187 {
 188         struct atm_vcc *vcc;
 189         struct k_message msg;
 190         unsigned char *ip;
 191
 192         vcc = entry->shortcut;
 193         ip = (unsigned char *)&entry->ctrl_info.in_dst_ip;
 194         dprintk("mpoa: mpoa_caches.c: removing an ingress entry, ip = %u.%u.%u.%u\n",ip[0], ip[1], ip[2], ip[3]);
 195
 196         if (entry->prev != NULL)
 197                 entry->prev->next = entry->next;
 198         else
 199                 client->in_cache = entry->next;
 200         if (entry->next != NULL)
 201                 entry->next->prev = entry->prev;
 202         client->in_ops->put(entry);
 203         if(client->in_cache == NULL && client->eg_cache == NULL){
 204                 msg.type = STOP_KEEP_ALIVE_SM;
 205                 msg_to_mpoad(&msg,client);
 206         }
 207
 208         /* Check if the egress side still uses this VCC */
 209         if (vcc != NULL) {
 210                 eg_cache_entry *eg_entry = client->eg_ops->get_by_vcc(vcc, client);
 211                 if (eg_entry != NULL) {
 212                         client->eg_ops->put(eg_entry);
 213                         return;
 214                 }
 215                 vcc_release_async(vcc, -EPIPE);
 216         }
 217
 218         return;
 219 }
 220
 221
 222 /* Call this every MPC-p2 seconds... Not exactly correct solution,
 223    but an easy one... */
 224 static void clear_count_and_expired(struct mpoa_client *client)
 225 {
 226         unsigned char *ip;
 227         in_cache_entry *entry, *next_entry;
 228         struct timeval now;
 229
 230         do_gettimeofday(&now);
 231
 232         write_lock_bh(&client->ingress_lock);
 233         entry = client->in_cache;
 234         while(entry != NULL){
 235                 entry->count=0;
 236                 next_entry = entry->next;
 237                 if((now.tv_sec - entry->tv.tv_sec)
 238                    > entry->ctrl_info.holding_time){
 239                         ip = (unsigned char*)&entry->ctrl_info.in_dst_ip;
 240                         dprintk("mpoa: mpoa_caches.c: holding time expired, ip = %u.%u.%u.%u\n", NIPQUAD(ip));
 241                         client->in_ops->remove_entry(entry, client);
 242                 }
 243                 entry = next_entry;
 244         }
 245         write_unlock_bh(&client->ingress_lock);
 246
 247         return;
 248 }
 249
 250 /* Call this every MPC-p4 seconds. */
 251 static void check_resolving_entries(struct mpoa_client *client)
 252 {
 253
 254         struct atm_mpoa_qos *qos;
 255         in_cache_entry *entry;
 256         struct timeval now;
 257         struct k_message msg;
 258
 259         do_gettimeofday( &now );
 260
 261         read_lock_bh(&client->ingress_lock);
 262         entry = client->in_cache;
 263         while( entry != NULL ){
 264                 if(entry->entry_state == INGRESS_RESOLVING){
 265                         if(now.tv_sec - entry->hold_down.tv_sec < client->parameters.mpc_p6){
 266                                 entry = entry->next;                      /* Entry in hold down */
 267                                 continue;
 268                         }
 269                         if( (now.tv_sec - entry->reply_wait.tv_sec) >
 270                             entry->retry_time ){
 271                                 entry->retry_time = MPC_C1*( entry->retry_time );
 272                                 if(entry->retry_time > client->parameters.mpc_p5){
 273                                         /* Retry time maximum exceeded, put entry in hold down. */
 274                                         do_gettimeofday(&(entry->hold_down));
 275                                         entry->retry_time = client->parameters.mpc_p4;
 276                                         entry = entry->next;
 277                                         continue;
 278                                 }
 279                                 /* Ask daemon to send a resolution request. */
 280                                 memset(&(entry->hold_down),0,sizeof(struct timeval));
 281                                 msg.type = SND_MPOA_RES_RTRY;
 282                                 memcpy(msg.MPS_ctrl, client->mps_ctrl_addr, ATM_ESA_LEN);
 283                                 msg.content.in_info = entry->ctrl_info;
 284                                 qos = atm_mpoa_search_qos(entry->ctrl_info.in_dst_ip);
 285                                 if (qos != NULL) msg.qos = qos->qos;
 286                                 msg_to_mpoad(&msg, client);
 287                                 do_gettimeofday(&(entry->reply_wait));
 288                         }
 289                 }
 290                 entry = entry->next;
 291         }
 292         read_unlock_bh(&client->ingress_lock);
 293 }
 294
 295 /* Call this every MPC-p5 seconds. */
 296 static void refresh_entries(struct mpoa_client *client)
 297 {
 298         struct timeval now;
 299         struct in_cache_entry *entry = client->in_cache;
 300
 301         ddprintk("mpoa: mpoa_caches.c: refresh_entries\n");
 302         do_gettimeofday(&now);
 303
 304         read_lock_bh(&client->ingress_lock);
 305         while( entry != NULL ){
 306                 if( entry->entry_state == INGRESS_RESOLVED ){
 307                         if(!(entry->refresh_time))
 308                                 entry->refresh_time = (2*(entry->ctrl_info.holding_time))/3;
 309                         if( (now.tv_sec - entry->reply_wait.tv_sec) > entry->refresh_time ){
 310                                 dprintk("mpoa: mpoa_caches.c: refreshing an entry.\n");
 311                                 entry->entry_state = INGRESS_REFRESHING;
 312
 313                         }
 314                 }
 315                 entry = entry->next;
 316         }
 317         read_unlock_bh(&client->ingress_lock);
 318 }
 319
 320 static void in_destroy_cache(struct mpoa_client *mpc)
 321 {
 322         write_lock_irq(&mpc->ingress_lock);
 323         while(mpc->in_cache != NULL)
 324                 mpc->in_ops->remove_entry(mpc->in_cache, mpc);
 325         write_unlock_irq(&mpc->ingress_lock);
 326
 327         return;
 328 }
 329
 330 static eg_cache_entry *eg_cache_get_by_cache_id(uint32_t cache_id, struct mpoa_client *mpc)
 331 {
 332         eg_cache_entry *entry;
 333
 334         read_lock_irq(&mpc->egress_lock);
 335         entry = mpc->eg_cache;
 336         while(entry != NULL){
 337                 if(entry->ctrl_info.cache_id == cache_id){
 338                         atomic_inc(&entry->use);
 339                         read_unlock_irq(&mpc->egress_lock);
 340                         return entry;
 341                 }
 342                 entry = entry->next;
 343         }
 344         read_unlock_irq(&mpc->egress_lock);
 345
 346         return NULL;
 347 }
 348
 349 /* This can be called from any context since it saves CPU flags */
 350 static eg_cache_entry *eg_cache_get_by_tag(uint32_t tag, struct mpoa_client *mpc)
 351 {
 352         unsigned long flags;
 353         eg_cache_entry *entry;
 354
 355         read_lock_irqsave(&mpc->egress_lock, flags);
 356         entry = mpc->eg_cache;
 357         while (entry != NULL){
 358                 if (entry->ctrl_info.tag == tag) {
 359                         atomic_inc(&entry->use);
 360                         read_unlock_irqrestore(&mpc->egress_lock, flags);
 361                         return entry;
 362                 }
 363                 entry = entry->next;
 364         }
 365         read_unlock_irqrestore(&mpc->egress_lock, flags);
 366
 367         return NULL;
 368 }
 369
 370 /* This can be called from any context since it saves CPU flags */
 371 static eg_cache_entry *eg_cache_get_by_vcc(struct atm_vcc *vcc, struct mpoa_client *mpc)
 372 {
 373         unsigned long flags;
 374         eg_cache_entry *entry;
 375
 376         read_lock_irqsave(&mpc->egress_lock, flags);
 377         entry = mpc->eg_cache;
 378         while (entry != NULL){
 379                 if (entry->shortcut == vcc) {
 380                         atomic_inc(&entry->use);
 381                         read_unlock_irqrestore(&mpc->egress_lock, flags);
 382                         return entry;
 383                 }
 384                 entry = entry->next;
 385         }
 386         read_unlock_irqrestore(&mpc->egress_lock, flags);
 387
 388         return NULL;
 389 }
 390
 391 static eg_cache_entry *eg_cache_get_by_src_ip(uint32_t ipaddr, struct mpoa_client *mpc)
 392 {
 393         eg_cache_entry *entry;
 394
 395         read_lock_irq(&mpc->egress_lock);
 396         entry = mpc->eg_cache;
 397         while(entry != NULL){
 398                 if(entry->latest_ip_addr == ipaddr) {
 399                         atomic_inc(&entry->use);
 400                         read_unlock_irq(&mpc->egress_lock);
 401                         return entry;
 402                 }
 403                 entry = entry->next;
 404         }
 405         read_unlock_irq(&mpc->egress_lock);
 406
 407         return NULL;
 408 }
 409
 410 static void eg_cache_put(eg_cache_entry *entry)
 411 {
 412         if (atomic_dec_and_test(&entry->use)) {
 413                 memset(entry, 0, sizeof(eg_cache_entry));
 414                 kfree(entry);
 415         }
 416
 417         return;
 418 }
 419
 420 /*
 421  * This should be called with write lock on
 422  */
 423 static void eg_cache_remove_entry(eg_cache_entry *entry,
 424                                   struct mpoa_client *client)
 425 {
 426         struct atm_vcc *vcc;
 427         struct k_message msg;
 428
 429         vcc = entry->shortcut;
 430         dprintk("mpoa: mpoa_caches.c: removing an egress entry.\n");
 431         if (entry->prev != NULL)
 432                 entry->prev->next = entry->next;
 433         else
 434                 client->eg_cache = entry->next;
 435         if (entry->next != NULL)
 436                 entry->next->prev = entry->prev;
 437         client->eg_ops->put(entry);
 438         if(client->in_cache == NULL && client->eg_cache == NULL){
 439                 msg.type = STOP_KEEP_ALIVE_SM;
 440                 msg_to_mpoad(&msg,client);
 441         }
 442
 443         /* Check if the ingress side still uses this VCC */
 444         if (vcc != NULL) {
 445                 in_cache_entry *in_entry = client->in_ops->get_by_vcc(vcc, client);
 446                 if (in_entry != NULL) {
 447                         client->in_ops->put(in_entry);
 448                         return;
 449                 }
 450                 vcc_release_async(vcc, -EPIPE);
 451         }
 452
 453         return;
 454 }
 455
 456 static eg_cache_entry *eg_cache_add_entry(struct k_message *msg, struct mpoa_client *client)
 457 {
 458         unsigned char *ip;
 459         eg_cache_entry *entry = kmalloc(sizeof(eg_cache_entry), GFP_KERNEL);
 460
 461         if (entry == NULL) {
 462                 printk("mpoa: mpoa_caches.c: new_eg_cache_entry: out of memory\n");
 463                 return NULL;
 464         }
 465
 466         ip = (unsigned char *)&msg->content.eg_info.eg_dst_ip;
 467         dprintk("mpoa: mpoa_caches.c: adding an egress entry, ip = %u.%u.%u.%u, this should be our IP\n", NIPQUAD(ip));
 468         memset(entry, 0, sizeof(eg_cache_entry));
 469
 470         atomic_set(&entry->use, 1);
 471         dprintk("mpoa: mpoa_caches.c: new_eg_cache_entry: about to lock\n");
 472         write_lock_irq(&client->egress_lock);
 473         entry->next = client->eg_cache;
 474         entry->prev = NULL;
 475         if (client->eg_cache != NULL)
 476                 client->eg_cache->prev = entry;
 477         client->eg_cache = entry;
 478
 479         memcpy(entry->MPS_ctrl_ATM_addr, client->mps_ctrl_addr, ATM_ESA_LEN);
 480         entry->ctrl_info = msg->content.eg_info;
 481         do_gettimeofday(&(entry->tv));
 482         entry->entry_state = EGRESS_RESOLVED;
 483         dprintk("mpoa: mpoa_caches.c: new_eg_cache_entry cache_id %lu\n", ntohl(entry->ctrl_info.cache_id));
 484         ip = (unsigned char *)&entry->ctrl_info.mps_ip;
 485         dprintk("mpoa: mpoa_caches.c: mps_ip = %u.%u.%u.%u\n", NIPQUAD(ip));
 486         atomic_inc(&entry->use);
 487
 488         write_unlock_irq(&client->egress_lock);
 489         dprintk("mpoa: mpoa_caches.c: new_eg_cache_entry: unlocked\n");
 490
 491         return entry;
 492 }
 493
 494 static void update_eg_cache_entry(eg_cache_entry * entry, uint16_t holding_time)
 495 {
 496         do_gettimeofday(&(entry->tv));
 497         entry->entry_state = EGRESS_RESOLVED;
 498         entry->ctrl_info.holding_time = holding_time;
 499
 500         return;
 501 }
 502
 503 static void clear_expired(struct mpoa_client *client)
 504 {
 505         eg_cache_entry *entry, *next_entry;
 506         struct timeval now;
 507         struct k_message msg;
 508
 509         do_gettimeofday(&now);
 510
 511         write_lock_irq(&client->egress_lock);
 512         entry = client->eg_cache;
 513         while(entry != NULL){
 514                 next_entry = entry->next;
 515                 if((now.tv_sec - entry->tv.tv_sec)
 516                    > entry->ctrl_info.holding_time){
 517                         msg.type = SND_EGRESS_PURGE;
 518                         msg.content.eg_info = entry->ctrl_info;
 519                         dprintk("mpoa: mpoa_caches.c: egress_cache: holding time expired, cache_id = %lu.\n",ntohl(entry->ctrl_info.cache_id));
 520                         msg_to_mpoad(&msg, client);
 521                         client->eg_ops->remove_entry(entry, client);
 522                 }
 523                 entry = next_entry;
 524         }
 525         write_unlock_irq(&client->egress_lock);
 526
 527         return;
 528 }
 529
 530 static void eg_destroy_cache(struct mpoa_client *mpc)
 531 {
 532         write_lock_irq(&mpc->egress_lock);
 533         while(mpc->eg_cache != NULL)
 534                 mpc->eg_ops->remove_entry(mpc->eg_cache, mpc);
 535         write_unlock_irq(&mpc->egress_lock);
 536
 537         return;
 538 }
 539
 540
 541
 542 static struct in_cache_ops ingress_ops = {
 543         in_cache_add_entry,               /* add_entry       */
 544         in_cache_get,                     /* get             */
 545         in_cache_get_with_mask,           /* get_with_mask   */
 546         in_cache_get_by_vcc,              /* get_by_vcc      */
 547         in_cache_put,                     /* put             */
 548         in_cache_remove_entry,            /* remove_entry    */
 549         cache_hit,                        /* cache_hit       */
 550         clear_count_and_expired,          /* clear_count     */
 551         check_resolving_entries,          /* check_resolving */
 552         refresh_entries,                  /* refresh         */
 553         in_destroy_cache                  /* destroy_cache   */
 554 };
 555
 556 static struct eg_cache_ops egress_ops = {
 557         eg_cache_add_entry,               /* add_entry        */
 558         eg_cache_get_by_cache_id,         /* get_by_cache_id  */
 559         eg_cache_get_by_tag,              /* get_by_tag       */
 560         eg_cache_get_by_vcc,              /* get_by_vcc       */
 561         eg_cache_get_by_src_ip,           /* get_by_src_ip    */
 562         eg_cache_put,                     /* put              */
 563         eg_cache_remove_entry,            /* remove_entry     */
 564         update_eg_cache_entry,            /* update           */
 565         clear_expired,                    /* clear_expired    */
 566         eg_destroy_cache                  /* destroy_cache    */
 567 };
 568
 569
 570 void atm_mpoa_init_cache(struct mpoa_client *mpc)
 571 {
 572         mpc->in_ops = &ingress_ops;
 573         mpc->eg_ops = &egress_ops;
 574
 575         return;
 576 }