git.oblomov.eu Git - linux-2.6/blob - drivers/block/aoe/aoecmd.c

   1 /* Copyright (c) 2004 Coraid, Inc.  See COPYING for GPL terms. */
   2 /*
   3  * aoecmd.c
   4  * Filesystem request handling methods
   5  */
   6
   7 #include <linux/hdreg.h>
   8 #include <linux/blkdev.h>
   9 #include <linux/skbuff.h>
  10 #include <linux/netdevice.h>
  11 #include <asm/unaligned.h>
  12 #include "aoe.h"
  13
  14 #define TIMERTICK (HZ / 10)
  15 #define MINTIMER (2 * TIMERTICK)
  16 #define MAXTIMER (HZ << 1)
  17 #define MAXWAIT (60 * 3)        /* After MAXWAIT seconds, give up and fail dev */
  18
  19 static struct sk_buff *
  20 new_skb(struct net_device *if_dev, ulong len)
  21 {
  22         struct sk_buff *skb;
  23
  24         skb = alloc_skb(len, GFP_ATOMIC);
  25         if (skb) {
  26                 skb->nh.raw = skb->mac.raw = skb->data;
  27                 skb->dev = if_dev;
  28                 skb->protocol = __constant_htons(ETH_P_AOE);
  29                 skb->priority = 0;
  30                 skb_put(skb, len);
  31                 skb->next = skb->prev = NULL;
  32
  33                 /* tell the network layer not to perform IP checksums
  34                  * or to get the NIC to do it
  35                  */
  36                 skb->ip_summed = CHECKSUM_NONE;
  37         }
  38         return skb;
  39 }
  40
  41 static struct sk_buff *
  42 skb_prepare(struct aoedev *d, struct frame *f)
  43 {
  44         struct sk_buff *skb;
  45         char *p;
  46
  47         skb = new_skb(d->ifp, f->ndata + f->writedatalen);
  48         if (!skb) {
  49                 printk(KERN_INFO "aoe: skb_prepare: failure to allocate skb\n");
  50                 return NULL;
  51         }
  52
  53         p = skb->mac.raw;
  54         memcpy(p, f->data, f->ndata);
  55
  56         if (f->writedatalen) {
  57                 p += sizeof(struct aoe_hdr) + sizeof(struct aoe_atahdr);
  58                 memcpy(p, f->bufaddr, f->writedatalen);
  59         }
  60
  61         return skb;
  62 }
  63
  64 static struct frame *
  65 getframe(struct aoedev *d, int tag)
  66 {
  67         struct frame *f, *e;
  68
  69         f = d->frames;
  70         e = f + d->nframes;
  71         for (; f<e; f++)
  72                 if (f->tag == tag)
  73                         return f;
  74         return NULL;
  75 }
  76
  77 /*
  78  * Leave the top bit clear so we have tagspace for userland.
  79  * The bottom 16 bits are the xmit tick for rexmit/rttavg processing.
  80  * This driver reserves tag -1 to mean "unused frame."
  81  */
  82 static int
  83 newtag(struct aoedev *d)
  84 {
  85         register ulong n;
  86
  87         n = jiffies & 0xffff;
  88         return n |= (++d->lasttag & 0x7fff) << 16;
  89 }
  90
  91 static int
  92 aoehdr_atainit(struct aoedev *d, struct aoe_hdr *h)
  93 {
  94         u32 host_tag = newtag(d);
  95
  96         memcpy(h->src, d->ifp->dev_addr, sizeof h->src);
  97         memcpy(h->dst, d->addr, sizeof h->dst);
  98         h->type = __constant_cpu_to_be16(ETH_P_AOE);
  99         h->verfl = AOE_HVER;
 100         h->major = cpu_to_be16(d->aoemajor);
 101         h->minor = d->aoeminor;
 102         h->cmd = AOECMD_ATA;
 103         h->tag = cpu_to_be32(host_tag);
 104
 105         return host_tag;
 106 }
 107
 108 static void
 109 aoecmd_ata_rw(struct aoedev *d, struct frame *f)
 110 {
 111         struct aoe_hdr *h;
 112         struct aoe_atahdr *ah;
 113         struct buf *buf;
 114         struct sk_buff *skb;
 115         ulong bcnt;
 116         register sector_t sector;
 117         char writebit, extbit;
 118
 119         writebit = 0x10;
 120         extbit = 0x4;
 121
 122         buf = d->inprocess;
 123
 124         sector = buf->sector;
 125         bcnt = buf->bv_resid;
 126         if (bcnt > MAXATADATA)
 127                 bcnt = MAXATADATA;
 128
 129         /* initialize the headers & frame */
 130         h = (struct aoe_hdr *) f->data;
 131         ah = (struct aoe_atahdr *) (h+1);
 132         f->ndata = sizeof *h + sizeof *ah;
 133         memset(h, 0, f->ndata);
 134         f->tag = aoehdr_atainit(d, h);
 135         f->waited = 0;
 136         f->buf = buf;
 137         f->bufaddr = buf->bufaddr;
 138
 139         /* set up ata header */
 140         ah->scnt = bcnt >> 9;
 141         ah->lba0 = sector;
 142         ah->lba1 = sector >>= 8;
 143         ah->lba2 = sector >>= 8;
 144         ah->lba3 = sector >>= 8;
 145         if (d->flags & DEVFL_EXT) {
 146                 ah->aflags |= AOEAFL_EXT;
 147                 ah->lba4 = sector >>= 8;
 148                 ah->lba5 = sector >>= 8;
 149         } else {
 150                 extbit = 0;
 151                 ah->lba3 &= 0x0f;
 152                 ah->lba3 |= 0xe0;       /* LBA bit + obsolete 0xa0 */
 153         }
 154
 155         if (bio_data_dir(buf->bio) == WRITE) {
 156                 ah->aflags |= AOEAFL_WRITE;
 157                 f->writedatalen = bcnt;
 158         } else {
 159                 writebit = 0;
 160                 f->writedatalen = 0;
 161         }
 162
 163         ah->cmdstat = WIN_READ | writebit | extbit;
 164
 165         /* mark all tracking fields and load out */
 166         buf->nframesout += 1;
 167         buf->bufaddr += bcnt;
 168         buf->bv_resid -= bcnt;
 169 /* printk(KERN_INFO "aoe: bv_resid=%ld\n", buf->bv_resid); */
 170         buf->resid -= bcnt;
 171         buf->sector += bcnt >> 9;
 172         if (buf->resid == 0) {
 173                 d->inprocess = NULL;
 174         } else if (buf->bv_resid == 0) {
 175                 buf->bv++;
 176                 buf->bv_resid = buf->bv->bv_len;
 177                 buf->bufaddr = page_address(buf->bv->bv_page) + buf->bv->bv_offset;
 178         }
 179
 180         skb = skb_prepare(d, f);
 181         if (skb) {
 182                 skb->next = NULL;
 183                 if (d->sendq_hd)
 184                         d->sendq_tl->next = skb;
 185                 else
 186                         d->sendq_hd = skb;
 187                 d->sendq_tl = skb;
 188         }
 189 }
 190
 191 /* enters with d->lock held */
 192 void
 193 aoecmd_work(struct aoedev *d)
 194 {
 195         struct frame *f;
 196         struct buf *buf;
 197 loop:
 198         f = getframe(d, FREETAG);
 199         if (f == NULL)
 200                 return;
 201         if (d->inprocess == NULL) {
 202                 if (list_empty(&d->bufq))
 203                         return;
 204                 buf = container_of(d->bufq.next, struct buf, bufs);
 205                 list_del(d->bufq.next);
 206 /*printk(KERN_INFO "aoecmd_work: bi_size=%ld\n", buf->bio->bi_size); */
 207                 d->inprocess = buf;
 208         }
 209         aoecmd_ata_rw(d, f);
 210         goto loop;
 211 }
 212
 213 static void
 214 rexmit(struct aoedev *d, struct frame *f)
 215 {
 216         struct sk_buff *skb;
 217         struct aoe_hdr *h;
 218         char buf[128];
 219         u32 n;
 220
 221         n = newtag(d);
 222
 223         snprintf(buf, sizeof buf,
 224                 "%15s e%ld.%ld oldtag=%08x@%08lx newtag=%08x\n",
 225                 "retransmit",
 226                 d->aoemajor, d->aoeminor, f->tag, jiffies, n);
 227         aoechr_error(buf);
 228
 229         h = (struct aoe_hdr *) f->data;
 230         f->tag = n;
 231         h->tag = cpu_to_be32(n);
 232
 233         skb = skb_prepare(d, f);
 234         if (skb) {
 235                 skb->next = NULL;
 236                 if (d->sendq_hd)
 237                         d->sendq_tl->next = skb;
 238                 else
 239                         d->sendq_hd = skb;
 240                 d->sendq_tl = skb;
 241         }
 242 }
 243
 244 static int
 245 tsince(int tag)
 246 {
 247         int n;
 248
 249         n = jiffies & 0xffff;
 250         n -= tag & 0xffff;
 251         if (n < 0)
 252                 n += 1<<16;
 253         return n;
 254 }
 255
 256 static void
 257 rexmit_timer(ulong vp)
 258 {
 259         struct aoedev *d;
 260         struct frame *f, *e;
 261         struct sk_buff *sl;
 262         register long timeout;
 263         ulong flags, n;
 264
 265         d = (struct aoedev *) vp;
 266         sl = NULL;
 267
 268         /* timeout is always ~150% of the moving average */
 269         timeout = d->rttavg;
 270         timeout += timeout >> 1;
 271
 272         spin_lock_irqsave(&d->lock, flags);
 273
 274         if (d->flags & DEVFL_TKILL) {
 275 tdie:           spin_unlock_irqrestore(&d->lock, flags);
 276                 return;
 277         }
 278         f = d->frames;
 279         e = f + d->nframes;
 280         for (; f<e; f++) {
 281                 if (f->tag != FREETAG && tsince(f->tag) >= timeout) {
 282                         n = f->waited += timeout;
 283                         n /= HZ;
 284                         if (n > MAXWAIT) { /* waited too long.  device failure. */
 285                                 aoedev_downdev(d);
 286                                 goto tdie;
 287                         }
 288                         rexmit(d, f);
 289                 }
 290         }
 291
 292         sl = d->sendq_hd;
 293         d->sendq_hd = d->sendq_tl = NULL;
 294         if (sl) {
 295                 n = d->rttavg <<= 1;
 296                 if (n > MAXTIMER)
 297                         d->rttavg = MAXTIMER;
 298         }
 299
 300         d->timer.expires = jiffies + TIMERTICK;
 301         add_timer(&d->timer);
 302
 303         spin_unlock_irqrestore(&d->lock, flags);
 304
 305         aoenet_xmit(sl);
 306 }
 307
 308 static void
 309 ataid_complete(struct aoedev *d, unsigned char *id)
 310 {
 311         u64 ssize;
 312         u16 n;
 313
 314         /* word 83: command set supported */
 315         n = le16_to_cpu(get_unaligned((__le16 *) &id[83<<1]));
 316
 317         /* word 86: command set/feature enabled */
 318         n |= le16_to_cpu(get_unaligned((__le16 *) &id[86<<1]));
 319
 320         if (n & (1<<10)) {      /* bit 10: LBA 48 */
 321                 d->flags |= DEVFL_EXT;
 322
 323                 /* word 100: number lba48 sectors */
 324                 ssize = le64_to_cpu(get_unaligned((__le64 *) &id[100<<1]));
 325
 326                 /* set as in ide-disk.c:init_idedisk_capacity */
 327                 d->geo.cylinders = ssize;
 328                 d->geo.cylinders /= (255 * 63);
 329                 d->geo.heads = 255;
 330                 d->geo.sectors = 63;
 331         } else {
 332                 d->flags &= ~DEVFL_EXT;
 333
 334                 /* number lba28 sectors */
 335                 ssize = le32_to_cpu(get_unaligned((__le32 *) &id[60<<1]));
 336
 337                 /* NOTE: obsolete in ATA 6 */
 338                 d->geo.cylinders = le16_to_cpu(get_unaligned((__le16 *) &id[54<<1]));
 339                 d->geo.heads = le16_to_cpu(get_unaligned((__le16 *) &id[55<<1]));
 340                 d->geo.sectors = le16_to_cpu(get_unaligned((__le16 *) &id[56<<1]));
 341         }
 342         d->ssize = ssize;
 343         d->geo.start = 0;
 344         if (d->gd != NULL) {
 345                 d->gd->capacity = ssize;
 346                 d->flags |= DEVFL_UP;
 347                 return;
 348         }
 349         if (d->flags & DEVFL_WORKON) {
 350                 printk(KERN_INFO "aoe: ataid_complete: can't schedule work, it's already on!  "
 351                         "(This really shouldn't happen).\n");
 352                 return;
 353         }
 354         INIT_WORK(&d->work, aoeblk_gdalloc, d);
 355         schedule_work(&d->work);
 356         d->flags |= DEVFL_WORKON;
 357 }
 358
 359 static void
 360 calc_rttavg(struct aoedev *d, int rtt)
 361 {
 362         register long n;
 363
 364         n = rtt;
 365         if (n < MINTIMER)
 366                 n = MINTIMER;
 367         else if (n > MAXTIMER)
 368                 n = MAXTIMER;
 369
 370         /* g == .25; cf. Congestion Avoidance and Control, Jacobson & Karels; 1988 */
 371         n -= d->rttavg;
 372         d->rttavg += n >> 2;
 373 }
 374
 375 void
 376 aoecmd_ata_rsp(struct sk_buff *skb)
 377 {
 378         struct aoedev *d;
 379         struct aoe_hdr *hin;
 380         struct aoe_atahdr *ahin, *ahout;
 381         struct frame *f;
 382         struct buf *buf;
 383         struct sk_buff *sl;
 384         register long n;
 385         ulong flags;
 386         char ebuf[128];
 387         u16 aoemajor;
 388
 389         hin = (struct aoe_hdr *) skb->mac.raw;
 390         aoemajor = be16_to_cpu(hin->major);
 391         d = aoedev_by_aoeaddr(aoemajor, hin->minor);
 392         if (d == NULL) {
 393                 snprintf(ebuf, sizeof ebuf, "aoecmd_ata_rsp: ata response "
 394                         "for unknown device %d.%d\n",
 395                          aoemajor, hin->minor);
 396                 aoechr_error(ebuf);
 397                 return;
 398         }
 399
 400         spin_lock_irqsave(&d->lock, flags);
 401
 402         f = getframe(d, be32_to_cpu(hin->tag));
 403         if (f == NULL) {
 404                 spin_unlock_irqrestore(&d->lock, flags);
 405                 snprintf(ebuf, sizeof ebuf,
 406                         "%15s e%d.%d    tag=%08x@%08lx\n",
 407                         "unexpected rsp",
 408                         be16_to_cpu(hin->major),
 409                         hin->minor,
 410                         be32_to_cpu(hin->tag),
 411                         jiffies);
 412                 aoechr_error(ebuf);
 413                 return;
 414         }
 415
 416         calc_rttavg(d, tsince(f->tag));
 417
 418         ahin = (struct aoe_atahdr *) (hin+1);
 419         ahout = (struct aoe_atahdr *) (f->data + sizeof(struct aoe_hdr));
 420         buf = f->buf;
 421
 422         if (ahin->cmdstat & 0xa9) {     /* these bits cleared on success */
 423                 printk(KERN_CRIT "aoe: aoecmd_ata_rsp: ata error cmd=%2.2Xh "
 424                         "stat=%2.2Xh from e%ld.%ld\n",
 425                         ahout->cmdstat, ahin->cmdstat,
 426                         d->aoemajor, d->aoeminor);
 427                 if (buf)
 428                         buf->flags |= BUFFL_FAIL;
 429         } else {
 430                 switch (ahout->cmdstat) {
 431                 case WIN_READ:
 432                 case WIN_READ_EXT:
 433                         n = ahout->scnt << 9;
 434                         if (skb->len - sizeof *hin - sizeof *ahin < n) {
 435                                 printk(KERN_CRIT "aoe: aoecmd_ata_rsp: runt "
 436                                         "ata data size in read.  skb->len=%d\n",
 437                                         skb->len);
 438                                 /* fail frame f?  just returning will rexmit. */
 439                                 spin_unlock_irqrestore(&d->lock, flags);
 440                                 return;
 441                         }
 442                         memcpy(f->bufaddr, ahin+1, n);
 443                 case WIN_WRITE:
 444                 case WIN_WRITE_EXT:
 445                         break;
 446                 case WIN_IDENTIFY:
 447                         if (skb->len - sizeof *hin - sizeof *ahin < 512) {
 448                                 printk(KERN_INFO "aoe: aoecmd_ata_rsp: runt data size "
 449                                         "in ataid.  skb->len=%d\n", skb->len);
 450                                 spin_unlock_irqrestore(&d->lock, flags);
 451                                 return;
 452                         }
 453                         ataid_complete(d, (char *) (ahin+1));
 454                         /* d->flags |= DEVFL_WC_UPDATE; */
 455                         break;
 456                 default:
 457                         printk(KERN_INFO "aoe: aoecmd_ata_rsp: unrecognized "
 458                                "outbound ata command %2.2Xh for %d.%d\n",
 459                                ahout->cmdstat,
 460                                be16_to_cpu(hin->major),
 461                                hin->minor);
 462                 }
 463         }
 464
 465         if (buf) {
 466                 buf->nframesout -= 1;
 467                 if (buf->nframesout == 0 && buf->resid == 0) {
 468                         unsigned long duration = jiffies - buf->start_time;
 469                         unsigned long n_sect = buf->bio->bi_size >> 9;
 470                         struct gendisk *disk = d->gd;
 471
 472                         if (bio_data_dir(buf->bio) == WRITE) {
 473                                 disk_stat_inc(disk, writes);
 474                                 disk_stat_add(disk, write_ticks, duration);
 475                                 disk_stat_add(disk, write_sectors, n_sect);
 476                         } else {
 477                                 disk_stat_inc(disk, reads);
 478                                 disk_stat_add(disk, read_ticks, duration);
 479                                 disk_stat_add(disk, read_sectors, n_sect);
 480                         }
 481                         disk_stat_add(disk, io_ticks, duration);
 482                         n = (buf->flags & BUFFL_FAIL) ? -EIO : 0;
 483                         bio_endio(buf->bio, buf->bio->bi_size, n);
 484                         mempool_free(buf, d->bufpool);
 485                 }
 486         }
 487
 488         f->buf = NULL;
 489         f->tag = FREETAG;
 490
 491         aoecmd_work(d);
 492
 493         sl = d->sendq_hd;
 494         d->sendq_hd = d->sendq_tl = NULL;
 495
 496         spin_unlock_irqrestore(&d->lock, flags);
 497
 498         aoenet_xmit(sl);
 499 }
 500
 501 void
 502 aoecmd_cfg(ushort aoemajor, unsigned char aoeminor)
 503 {
 504         struct aoe_hdr *h;
 505         struct aoe_cfghdr *ch;
 506         struct sk_buff *skb, *sl;
 507         struct net_device *ifp;
 508
 509         sl = NULL;
 510
 511         read_lock(&dev_base_lock);
 512         for (ifp = dev_base; ifp; dev_put(ifp), ifp = ifp->next) {
 513                 dev_hold(ifp);
 514                 if (!is_aoe_netif(ifp))
 515                         continue;
 516
 517                 skb = new_skb(ifp, sizeof *h + sizeof *ch);
 518                 if (skb == NULL) {
 519                         printk(KERN_INFO "aoe: aoecmd_cfg: skb alloc failure\n");
 520                         continue;
 521                 }
 522                 h = (struct aoe_hdr *) skb->mac.raw;
 523                 memset(h, 0, sizeof *h + sizeof *ch);
 524
 525                 memset(h->dst, 0xff, sizeof h->dst);
 526                 memcpy(h->src, ifp->dev_addr, sizeof h->src);
 527                 h->type = __constant_cpu_to_be16(ETH_P_AOE);
 528                 h->verfl = AOE_HVER;
 529                 h->major = cpu_to_be16(aoemajor);
 530                 h->minor = aoeminor;
 531                 h->cmd = AOECMD_CFG;
 532
 533                 skb->next = sl;
 534                 sl = skb;
 535         }
 536         read_unlock(&dev_base_lock);
 537
 538         aoenet_xmit(sl);
 539 }
 540
 541 /*
 542  * Since we only call this in one place (and it only prepares one frame)
 543  * we just return the skb.  Usually we'd chain it up to the aoedev sendq.
 544  */
 545 static struct sk_buff *
 546 aoecmd_ata_id(struct aoedev *d)
 547 {
 548         struct aoe_hdr *h;
 549         struct aoe_atahdr *ah;
 550         struct frame *f;
 551         struct sk_buff *skb;
 552
 553         f = getframe(d, FREETAG);
 554         if (f == NULL) {
 555                 printk(KERN_CRIT "aoe: aoecmd_ata_id: can't get a frame.  "
 556                         "This shouldn't happen.\n");
 557                 return NULL;
 558         }
 559
 560         /* initialize the headers & frame */
 561         h = (struct aoe_hdr *) f->data;
 562         ah = (struct aoe_atahdr *) (h+1);
 563         f->ndata = sizeof *h + sizeof *ah;
 564         memset(h, 0, f->ndata);
 565         f->tag = aoehdr_atainit(d, h);
 566         f->waited = 0;
 567         f->writedatalen = 0;
 568
 569         /* this message initializes the device, so we reset the rttavg */
 570         d->rttavg = MAXTIMER;
 571
 572         /* set up ata header */
 573         ah->scnt = 1;
 574         ah->cmdstat = WIN_IDENTIFY;
 575         ah->lba3 = 0xa0;
 576
 577         skb = skb_prepare(d, f);
 578
 579         /* we now want to start the rexmit tracking */
 580         d->flags &= ~DEVFL_TKILL;
 581         d->timer.data = (ulong) d;
 582         d->timer.function = rexmit_timer;
 583         d->timer.expires = jiffies + TIMERTICK;
 584         add_timer(&d->timer);
 585
 586         return skb;
 587 }
 588
 589 void
 590 aoecmd_cfg_rsp(struct sk_buff *skb)
 591 {
 592         struct aoedev *d;
 593         struct aoe_hdr *h;
 594         struct aoe_cfghdr *ch;
 595         ulong flags, sysminor, aoemajor;
 596         u16 bufcnt;
 597         struct sk_buff *sl;
 598         enum { MAXFRAMES = 8 };
 599
 600         h = (struct aoe_hdr *) skb->mac.raw;
 601         ch = (struct aoe_cfghdr *) (h+1);
 602
 603         /*
 604          * Enough people have their dip switches set backwards to
 605          * warrant a loud message for this special case.
 606          */
 607         aoemajor = be16_to_cpu(h->major);
 608         if (aoemajor == 0xfff) {
 609                 printk(KERN_CRIT "aoe: aoecmd_cfg_rsp: Warning: shelf "
 610                         "address is all ones.  Check shelf dip switches\n");
 611                 return;
 612         }
 613
 614         sysminor = SYSMINOR(aoemajor, h->minor);
 615         if (sysminor * AOE_PARTITIONS + AOE_PARTITIONS > MINORMASK) {
 616                 printk(KERN_INFO
 617                         "aoe: e%ld.%d: minor number too large\n",
 618                         aoemajor, (int) h->minor);
 619                 return;
 620         }
 621
 622         bufcnt = be16_to_cpu(ch->bufcnt);
 623         if (bufcnt > MAXFRAMES) /* keep it reasonable */
 624                 bufcnt = MAXFRAMES;
 625
 626         d = aoedev_set(sysminor, h->src, skb->dev, bufcnt);
 627         if (d == NULL) {
 628                 printk(KERN_INFO "aoe: aoecmd_cfg_rsp: device set failure\n");
 629                 return;
 630         }
 631
 632         spin_lock_irqsave(&d->lock, flags);
 633
 634         if (d->flags & (DEVFL_UP | DEVFL_CLOSEWAIT)) {
 635                 spin_unlock_irqrestore(&d->lock, flags);
 636                 return;
 637         }
 638
 639         d->fw_ver = be16_to_cpu(ch->fwver);
 640
 641         /* we get here only if the device is new */
 642         sl = aoecmd_ata_id(d);
 643
 644         spin_unlock_irqrestore(&d->lock, flags);
 645
 646         aoenet_xmit(sl);
 647 }
 648