git.oblomov.eu Git - linux-2.6/blob - drivers/ssb/pcmcia.c

   1 /*
   2  * Sonics Silicon Backplane
   3  * PCMCIA-Hostbus related functions
   4  *
   5  * Copyright 2006 Johannes Berg <johannes@sipsolutions.net>
   6  * Copyright 2007-2008 Michael Buesch <mb@bu3sch.de>
   7  *
   8  * Licensed under the GNU/GPL. See COPYING for details.
   9  */
  10
  11 #include <linux/ssb/ssb.h>
  12 #include <linux/delay.h>
  13 #include <linux/io.h>
  14 #include <linux/etherdevice.h>
  15
  16 #include <pcmcia/cs_types.h>
  17 #include <pcmcia/cs.h>
  18 #include <pcmcia/cistpl.h>
  19 #include <pcmcia/ciscode.h>
  20 #include <pcmcia/ds.h>
  21 #include <pcmcia/cisreg.h>
  22
  23 #include "ssb_private.h"
  24
  25
  26 /* Define the following to 1 to enable a printk on each coreswitch. */
  27 #define SSB_VERBOSE_PCMCIACORESWITCH_DEBUG              0
  28
  29
  30 /* PCMCIA configuration registers */
  31 #define SSB_PCMCIA_ADDRESS0             0x2E
  32 #define SSB_PCMCIA_ADDRESS1             0x30
  33 #define SSB_PCMCIA_ADDRESS2             0x32
  34 #define SSB_PCMCIA_MEMSEG               0x34
  35 #define SSB_PCMCIA_SPROMCTL             0x36
  36 #define  SSB_PCMCIA_SPROMCTL_IDLE       0
  37 #define  SSB_PCMCIA_SPROMCTL_WRITE      1
  38 #define  SSB_PCMCIA_SPROMCTL_READ       2
  39 #define  SSB_PCMCIA_SPROMCTL_WRITEEN    4
  40 #define  SSB_PCMCIA_SPROMCTL_WRITEDIS   7
  41 #define  SSB_PCMCIA_SPROMCTL_DONE       8
  42 #define SSB_PCMCIA_SPROM_DATALO         0x38
  43 #define SSB_PCMCIA_SPROM_DATAHI         0x3A
  44 #define SSB_PCMCIA_SPROM_ADDRLO         0x3C
  45 #define SSB_PCMCIA_SPROM_ADDRHI         0x3E
  46
  47 /* Hardware invariants CIS tuples */
  48 #define SSB_PCMCIA_CIS                  0x80
  49 #define  SSB_PCMCIA_CIS_ID              0x01
  50 #define  SSB_PCMCIA_CIS_BOARDREV        0x02
  51 #define  SSB_PCMCIA_CIS_PA              0x03
  52 #define   SSB_PCMCIA_CIS_PA_PA0B0_LO    0
  53 #define   SSB_PCMCIA_CIS_PA_PA0B0_HI    1
  54 #define   SSB_PCMCIA_CIS_PA_PA0B1_LO    2
  55 #define   SSB_PCMCIA_CIS_PA_PA0B1_HI    3
  56 #define   SSB_PCMCIA_CIS_PA_PA0B2_LO    4
  57 #define   SSB_PCMCIA_CIS_PA_PA0B2_HI    5
  58 #define   SSB_PCMCIA_CIS_PA_ITSSI       6
  59 #define   SSB_PCMCIA_CIS_PA_MAXPOW      7
  60 #define  SSB_PCMCIA_CIS_OEMNAME         0x04
  61 #define  SSB_PCMCIA_CIS_CCODE           0x05
  62 #define  SSB_PCMCIA_CIS_ANTENNA         0x06
  63 #define  SSB_PCMCIA_CIS_ANTGAIN         0x07
  64 #define  SSB_PCMCIA_CIS_BFLAGS          0x08
  65 #define  SSB_PCMCIA_CIS_LEDS            0x09
  66
  67 /* PCMCIA SPROM size. */
  68 #define SSB_PCMCIA_SPROM_SIZE           256
  69 #define SSB_PCMCIA_SPROM_SIZE_BYTES     (SSB_PCMCIA_SPROM_SIZE * sizeof(u16))
  70
  71
  72 /* Write to a PCMCIA configuration register. */
  73 static int ssb_pcmcia_cfg_write(struct ssb_bus *bus, u8 offset, u8 value)
  74 {
  75         conf_reg_t reg;
  76         int res;
  77
  78         memset(&reg, 0, sizeof(reg));
  79         reg.Offset = offset;
  80         reg.Action = CS_WRITE;
  81         reg.Value = value;
  82         res = pcmcia_access_configuration_register(bus->host_pcmcia, &reg);
  83         if (unlikely(res != CS_SUCCESS))
  84                 return -EBUSY;
  85
  86         return 0;
  87 }
  88
  89 /* Read from a PCMCIA configuration register. */
  90 static int ssb_pcmcia_cfg_read(struct ssb_bus *bus, u8 offset, u8 *value)
  91 {
  92         conf_reg_t reg;
  93         int res;
  94
  95         memset(&reg, 0, sizeof(reg));
  96         reg.Offset = offset;
  97         reg.Action = CS_READ;
  98         res = pcmcia_access_configuration_register(bus->host_pcmcia, &reg);
  99         if (unlikely(res != CS_SUCCESS))
 100                 return -EBUSY;
 101         *value = reg.Value;
 102
 103         return 0;
 104 }
 105
 106 int ssb_pcmcia_switch_coreidx(struct ssb_bus *bus,
 107                               u8 coreidx)
 108 {
 109         int err;
 110         int attempts = 0;
 111         u32 cur_core;
 112         u32 addr;
 113         u32 read_addr;
 114         u8 val;
 115
 116         addr = (coreidx * SSB_CORE_SIZE) + SSB_ENUM_BASE;
 117         while (1) {
 118                 err = ssb_pcmcia_cfg_write(bus, SSB_PCMCIA_ADDRESS0,
 119                                            (addr & 0x0000F000) >> 12);
 120                 if (err)
 121                         goto error;
 122                 err = ssb_pcmcia_cfg_write(bus, SSB_PCMCIA_ADDRESS1,
 123                                            (addr & 0x00FF0000) >> 16);
 124                 if (err)
 125                         goto error;
 126                 err = ssb_pcmcia_cfg_write(bus, SSB_PCMCIA_ADDRESS2,
 127                                            (addr & 0xFF000000) >> 24);
 128                 if (err)
 129                         goto error;
 130
 131                 read_addr = 0;
 132
 133                 err = ssb_pcmcia_cfg_read(bus, SSB_PCMCIA_ADDRESS0, &val);
 134                 if (err)
 135                         goto error;
 136                 read_addr |= ((u32)(val & 0x0F)) << 12;
 137                 err = ssb_pcmcia_cfg_read(bus, SSB_PCMCIA_ADDRESS1, &val);
 138                 if (err)
 139                         goto error;
 140                 read_addr |= ((u32)val) << 16;
 141                 err = ssb_pcmcia_cfg_read(bus, SSB_PCMCIA_ADDRESS2, &val);
 142                 if (err)
 143                         goto error;
 144                 read_addr |= ((u32)val) << 24;
 145
 146                 cur_core = (read_addr - SSB_ENUM_BASE) / SSB_CORE_SIZE;
 147                 if (cur_core == coreidx)
 148                         break;
 149
 150                 err = -ETIMEDOUT;
 151                 if (attempts++ > SSB_BAR0_MAX_RETRIES)
 152                         goto error;
 153                 udelay(10);
 154         }
 155
 156         return 0;
 157 error:
 158         ssb_printk(KERN_ERR PFX "Failed to switch to core %u\n", coreidx);
 159         return err;
 160 }
 161
 162 int ssb_pcmcia_switch_core(struct ssb_bus *bus,
 163                            struct ssb_device *dev)
 164 {
 165         int err;
 166
 167 #if SSB_VERBOSE_PCMCIACORESWITCH_DEBUG
 168         ssb_printk(KERN_INFO PFX
 169                    "Switching to %s core, index %d\n",
 170                    ssb_core_name(dev->id.coreid),
 171                    dev->core_index);
 172 #endif
 173
 174         err = ssb_pcmcia_switch_coreidx(bus, dev->core_index);
 175         if (!err)
 176                 bus->mapped_device = dev;
 177
 178         return err;
 179 }
 180
 181 int ssb_pcmcia_switch_segment(struct ssb_bus *bus, u8 seg)
 182 {
 183         int attempts = 0;
 184         int err;
 185         u8 val;
 186
 187         SSB_WARN_ON((seg != 0) && (seg != 1));
 188         while (1) {
 189                 err = ssb_pcmcia_cfg_write(bus, SSB_PCMCIA_MEMSEG, seg);
 190                 if (err)
 191                         goto error;
 192                 err = ssb_pcmcia_cfg_read(bus, SSB_PCMCIA_MEMSEG, &val);
 193                 if (err)
 194                         goto error;
 195                 if (val == seg)
 196                         break;
 197
 198                 err = -ETIMEDOUT;
 199                 if (unlikely(attempts++ > SSB_BAR0_MAX_RETRIES))
 200                         goto error;
 201                 udelay(10);
 202         }
 203         bus->mapped_pcmcia_seg = seg;
 204
 205         return 0;
 206 error:
 207         ssb_printk(KERN_ERR PFX "Failed to switch pcmcia segment\n");
 208         return err;
 209 }
 210
 211 static int select_core_and_segment(struct ssb_device *dev,
 212                                    u16 *offset)
 213 {
 214         struct ssb_bus *bus = dev->bus;
 215         int err;
 216         u8 need_segment;
 217
 218         if (*offset >= 0x800) {
 219                 *offset -= 0x800;
 220                 need_segment = 1;
 221         } else
 222                 need_segment = 0;
 223
 224         if (unlikely(dev != bus->mapped_device)) {
 225                 err = ssb_pcmcia_switch_core(bus, dev);
 226                 if (unlikely(err))
 227                         return err;
 228         }
 229         if (unlikely(need_segment != bus->mapped_pcmcia_seg)) {
 230                 err = ssb_pcmcia_switch_segment(bus, need_segment);
 231                 if (unlikely(err))
 232                         return err;
 233         }
 234
 235         return 0;
 236 }
 237
 238 static u8 ssb_pcmcia_read8(struct ssb_device *dev, u16 offset)
 239 {
 240         struct ssb_bus *bus = dev->bus;
 241         unsigned long flags;
 242         int err;
 243         u8 value = 0xFF;
 244
 245         spin_lock_irqsave(&bus->bar_lock, flags);
 246         err = select_core_and_segment(dev, &offset);
 247         if (likely(!err))
 248                 value = readb(bus->mmio + offset);
 249         spin_unlock_irqrestore(&bus->bar_lock, flags);
 250
 251         return value;
 252 }
 253
 254 static u16 ssb_pcmcia_read16(struct ssb_device *dev, u16 offset)
 255 {
 256         struct ssb_bus *bus = dev->bus;
 257         unsigned long flags;
 258         int err;
 259         u16 value = 0xFFFF;
 260
 261         spin_lock_irqsave(&bus->bar_lock, flags);
 262         err = select_core_and_segment(dev, &offset);
 263         if (likely(!err))
 264                 value = readw(bus->mmio + offset);
 265         spin_unlock_irqrestore(&bus->bar_lock, flags);
 266
 267         return value;
 268 }
 269
 270 static u32 ssb_pcmcia_read32(struct ssb_device *dev, u16 offset)
 271 {
 272         struct ssb_bus *bus = dev->bus;
 273         unsigned long flags;
 274         int err;
 275         u32 lo = 0xFFFFFFFF, hi = 0xFFFFFFFF;
 276
 277         spin_lock_irqsave(&bus->bar_lock, flags);
 278         err = select_core_and_segment(dev, &offset);
 279         if (likely(!err)) {
 280                 lo = readw(bus->mmio + offset);
 281                 hi = readw(bus->mmio + offset + 2);
 282         }
 283         spin_unlock_irqrestore(&bus->bar_lock, flags);
 284
 285         return (lo | (hi << 16));
 286 }
 287
 288 #ifdef CONFIG_SSB_BLOCKIO
 289 static void ssb_pcmcia_block_read(struct ssb_device *dev, void *buffer,
 290                                   size_t count, u16 offset, u8 reg_width)
 291 {
 292         struct ssb_bus *bus = dev->bus;
 293         unsigned long flags;
 294         void __iomem *addr = bus->mmio + offset;
 295         int err;
 296
 297         spin_lock_irqsave(&bus->bar_lock, flags);
 298         err = select_core_and_segment(dev, &offset);
 299         if (unlikely(err)) {
 300                 memset(buffer, 0xFF, count);
 301                 goto unlock;
 302         }
 303         switch (reg_width) {
 304         case sizeof(u8): {
 305                 u8 *buf = buffer;
 306
 307                 while (count) {
 308                         *buf = __raw_readb(addr);
 309                         buf++;
 310                         count--;
 311                 }
 312                 break;
 313         }
 314         case sizeof(u16): {
 315                 __le16 *buf = buffer;
 316
 317                 SSB_WARN_ON(count & 1);
 318                 while (count) {
 319                         *buf = (__force __le16)__raw_readw(addr);
 320                         buf++;
 321                         count -= 2;
 322                 }
 323                 break;
 324         }
 325         case sizeof(u32): {
 326                 __le16 *buf = buffer;
 327
 328                 SSB_WARN_ON(count & 3);
 329                 while (count) {
 330                         *buf = (__force __le16)__raw_readw(addr);
 331                         buf++;
 332                         *buf = (__force __le16)__raw_readw(addr + 2);
 333                         buf++;
 334                         count -= 4;
 335                 }
 336                 break;
 337         }
 338         default:
 339                 SSB_WARN_ON(1);
 340         }
 341 unlock:
 342         spin_unlock_irqrestore(&bus->bar_lock, flags);
 343 }
 344 #endif /* CONFIG_SSB_BLOCKIO */
 345
 346 static void ssb_pcmcia_write8(struct ssb_device *dev, u16 offset, u8 value)
 347 {
 348         struct ssb_bus *bus = dev->bus;
 349         unsigned long flags;
 350         int err;
 351
 352         spin_lock_irqsave(&bus->bar_lock, flags);
 353         err = select_core_and_segment(dev, &offset);
 354         if (likely(!err))
 355                 writeb(value, bus->mmio + offset);
 356         mmiowb();
 357         spin_unlock_irqrestore(&bus->bar_lock, flags);
 358 }
 359
 360 static void ssb_pcmcia_write16(struct ssb_device *dev, u16 offset, u16 value)
 361 {
 362         struct ssb_bus *bus = dev->bus;
 363         unsigned long flags;
 364         int err;
 365
 366         spin_lock_irqsave(&bus->bar_lock, flags);
 367         err = select_core_and_segment(dev, &offset);
 368         if (likely(!err))
 369                 writew(value, bus->mmio + offset);
 370         mmiowb();
 371         spin_unlock_irqrestore(&bus->bar_lock, flags);
 372 }
 373
 374 static void ssb_pcmcia_write32(struct ssb_device *dev, u16 offset, u32 value)
 375 {
 376         struct ssb_bus *bus = dev->bus;
 377         unsigned long flags;
 378         int err;
 379
 380         spin_lock_irqsave(&bus->bar_lock, flags);
 381         err = select_core_and_segment(dev, &offset);
 382         if (likely(!err)) {
 383                 writew((value & 0x0000FFFF), bus->mmio + offset);
 384                 writew(((value & 0xFFFF0000) >> 16), bus->mmio + offset + 2);
 385         }
 386         mmiowb();
 387         spin_unlock_irqrestore(&bus->bar_lock, flags);
 388 }
 389
 390 #ifdef CONFIG_SSB_BLOCKIO
 391 static void ssb_pcmcia_block_write(struct ssb_device *dev, const void *buffer,
 392                                    size_t count, u16 offset, u8 reg_width)
 393 {
 394         struct ssb_bus *bus = dev->bus;
 395         unsigned long flags;
 396         void __iomem *addr = bus->mmio + offset;
 397         int err;
 398
 399         spin_lock_irqsave(&bus->bar_lock, flags);
 400         err = select_core_and_segment(dev, &offset);
 401         if (unlikely(err))
 402                 goto unlock;
 403         switch (reg_width) {
 404         case sizeof(u8): {
 405                 const u8 *buf = buffer;
 406
 407                 while (count) {
 408                         __raw_writeb(*buf, addr);
 409                         buf++;
 410                         count--;
 411                 }
 412                 break;
 413         }
 414         case sizeof(u16): {
 415                 const __le16 *buf = buffer;
 416
 417                 SSB_WARN_ON(count & 1);
 418                 while (count) {
 419                         __raw_writew((__force u16)(*buf), addr);
 420                         buf++;
 421                         count -= 2;
 422                 }
 423                 break;
 424         }
 425         case sizeof(u32): {
 426                 const __le16 *buf = buffer;
 427
 428                 SSB_WARN_ON(count & 3);
 429                 while (count) {
 430                         __raw_writew((__force u16)(*buf), addr);
 431                         buf++;
 432                         __raw_writew((__force u16)(*buf), addr + 2);
 433                         buf++;
 434                         count -= 4;
 435                 }
 436                 break;
 437         }
 438         default:
 439                 SSB_WARN_ON(1);
 440         }
 441 unlock:
 442         mmiowb();
 443         spin_unlock_irqrestore(&bus->bar_lock, flags);
 444 }
 445 #endif /* CONFIG_SSB_BLOCKIO */
 446
 447 /* Not "static", as it's used in main.c */
 448 const struct ssb_bus_ops ssb_pcmcia_ops = {
 449         .read8          = ssb_pcmcia_read8,
 450         .read16         = ssb_pcmcia_read16,
 451         .read32         = ssb_pcmcia_read32,
 452         .write8         = ssb_pcmcia_write8,
 453         .write16        = ssb_pcmcia_write16,
 454         .write32        = ssb_pcmcia_write32,
 455 #ifdef CONFIG_SSB_BLOCKIO
 456         .block_read     = ssb_pcmcia_block_read,
 457         .block_write    = ssb_pcmcia_block_write,
 458 #endif
 459 };
 460
 461 static int ssb_pcmcia_sprom_command(struct ssb_bus *bus, u8 command)
 462 {
 463         unsigned int i;
 464         int err;
 465         u8 value;
 466
 467         err = ssb_pcmcia_cfg_write(bus, SSB_PCMCIA_SPROMCTL, command);
 468         if (err)
 469                 return err;
 470         for (i = 0; i < 1000; i++) {
 471                 err = ssb_pcmcia_cfg_read(bus, SSB_PCMCIA_SPROMCTL, &value);
 472                 if (err)
 473                         return err;
 474                 if (value & SSB_PCMCIA_SPROMCTL_DONE)
 475                         return 0;
 476                 udelay(10);
 477         }
 478
 479         return -ETIMEDOUT;
 480 }
 481
 482 /* offset is the 16bit word offset */
 483 static int ssb_pcmcia_sprom_read(struct ssb_bus *bus, u16 offset, u16 *value)
 484 {
 485         int err;
 486         u8 lo, hi;
 487
 488         offset *= 2; /* Make byte offset */
 489
 490         err = ssb_pcmcia_cfg_write(bus, SSB_PCMCIA_SPROM_ADDRLO,
 491                                    (offset & 0x00FF));
 492         if (err)
 493                 return err;
 494         err = ssb_pcmcia_cfg_write(bus, SSB_PCMCIA_SPROM_ADDRHI,
 495                                    (offset & 0xFF00) >> 8);
 496         if (err)
 497                 return err;
 498         err = ssb_pcmcia_sprom_command(bus, SSB_PCMCIA_SPROMCTL_READ);
 499         if (err)
 500                 return err;
 501         err = ssb_pcmcia_cfg_read(bus, SSB_PCMCIA_SPROM_DATALO, &lo);
 502         if (err)
 503                 return err;
 504         err = ssb_pcmcia_cfg_read(bus, SSB_PCMCIA_SPROM_DATAHI, &hi);
 505         if (err)
 506                 return err;
 507         *value = (lo | (((u16)hi) << 8));
 508
 509         return 0;
 510 }
 511
 512 /* offset is the 16bit word offset */
 513 static int ssb_pcmcia_sprom_write(struct ssb_bus *bus, u16 offset, u16 value)
 514 {
 515         int err;
 516
 517         offset *= 2; /* Make byte offset */
 518
 519         err = ssb_pcmcia_cfg_write(bus, SSB_PCMCIA_SPROM_ADDRLO,
 520                                    (offset & 0x00FF));
 521         if (err)
 522                 return err;
 523         err = ssb_pcmcia_cfg_write(bus, SSB_PCMCIA_SPROM_ADDRHI,
 524                                    (offset & 0xFF00) >> 8);
 525         if (err)
 526                 return err;
 527         err = ssb_pcmcia_cfg_write(bus, SSB_PCMCIA_SPROM_DATALO,
 528                                    (value & 0x00FF));
 529         if (err)
 530                 return err;
 531         err = ssb_pcmcia_cfg_write(bus, SSB_PCMCIA_SPROM_DATAHI,
 532                                    (value & 0xFF00) >> 8);
 533         if (err)
 534                 return err;
 535         err = ssb_pcmcia_sprom_command(bus, SSB_PCMCIA_SPROMCTL_WRITE);
 536         if (err)
 537                 return err;
 538         msleep(20);
 539
 540         return 0;
 541 }
 542
 543 /* Read the SPROM image. bufsize is in 16bit words. */
 544 static int ssb_pcmcia_sprom_read_all(struct ssb_bus *bus, u16 *sprom)
 545 {
 546         int err, i;
 547
 548         for (i = 0; i < SSB_PCMCIA_SPROM_SIZE; i++) {
 549                 err = ssb_pcmcia_sprom_read(bus, i, &sprom[i]);
 550                 if (err)
 551                         return err;
 552         }
 553
 554         return 0;
 555 }
 556
 557 /* Write the SPROM image. size is in 16bit words. */
 558 static int ssb_pcmcia_sprom_write_all(struct ssb_bus *bus, const u16 *sprom)
 559 {
 560         int i, err;
 561         bool failed = 0;
 562         size_t size = SSB_PCMCIA_SPROM_SIZE;
 563
 564         ssb_printk(KERN_NOTICE PFX
 565                    "Writing SPROM. Do NOT turn off the power! "
 566                    "Please stand by...\n");
 567         err = ssb_pcmcia_sprom_command(bus, SSB_PCMCIA_SPROMCTL_WRITEEN);
 568         if (err) {
 569                 ssb_printk(KERN_NOTICE PFX
 570                            "Could not enable SPROM write access.\n");
 571                 return -EBUSY;
 572         }
 573         ssb_printk(KERN_NOTICE PFX "[ 0%%");
 574         msleep(500);
 575         for (i = 0; i < size; i++) {
 576                 if (i == size / 4)
 577                         ssb_printk("25%%");
 578                 else if (i == size / 2)
 579                         ssb_printk("50%%");
 580                 else if (i == (size * 3) / 4)
 581                         ssb_printk("75%%");
 582                 else if (i % 2)
 583                         ssb_printk(".");
 584                 err = ssb_pcmcia_sprom_write(bus, i, sprom[i]);
 585                 if (err) {
 586                         ssb_printk("\n" KERN_NOTICE PFX
 587                                    "Failed to write to SPROM.\n");
 588                         failed = 1;
 589                         break;
 590                 }
 591         }
 592         err = ssb_pcmcia_sprom_command(bus, SSB_PCMCIA_SPROMCTL_WRITEDIS);
 593         if (err) {
 594                 ssb_printk("\n" KERN_NOTICE PFX
 595                            "Could not disable SPROM write access.\n");
 596                 failed = 1;
 597         }
 598         msleep(500);
 599         if (!failed) {
 600                 ssb_printk("100%% ]\n");
 601                 ssb_printk(KERN_NOTICE PFX "SPROM written.\n");
 602         }
 603
 604         return failed ? -EBUSY : 0;
 605 }
 606
 607 static int ssb_pcmcia_sprom_check_crc(const u16 *sprom, size_t size)
 608 {
 609         //TODO
 610         return 0;
 611 }
 612
 613 #define GOTO_ERROR_ON(condition, description) do {      \
 614         if (unlikely(condition)) {                      \
 615                 error_description = description;        \
 616                 goto error;                             \
 617         }                                               \
 618   } while (0)
 619
 620 int ssb_pcmcia_get_invariants(struct ssb_bus *bus,
 621                               struct ssb_init_invariants *iv)
 622 {
 623         tuple_t tuple;
 624         int res;
 625         unsigned char buf[32];
 626         struct ssb_sprom *sprom = &iv->sprom;
 627         struct ssb_boardinfo *bi = &iv->boardinfo;
 628         const char *error_description;
 629
 630         memset(sprom, 0xFF, sizeof(*sprom));
 631         sprom->revision = 1;
 632         sprom->boardflags_lo = 0;
 633         sprom->boardflags_hi = 0;
 634
 635         /* First fetch the MAC address. */
 636         memset(&tuple, 0, sizeof(tuple));
 637         tuple.DesiredTuple = CISTPL_FUNCE;
 638         tuple.TupleData = buf;
 639         tuple.TupleDataMax = sizeof(buf);
 640         res = pcmcia_get_first_tuple(bus->host_pcmcia, &tuple);
 641         GOTO_ERROR_ON(res != CS_SUCCESS, "MAC first tpl");
 642         res = pcmcia_get_tuple_data(bus->host_pcmcia, &tuple);
 643         GOTO_ERROR_ON(res != CS_SUCCESS, "MAC first tpl data");
 644         while (1) {
 645                 GOTO_ERROR_ON(tuple.TupleDataLen < 1, "MAC tpl < 1");
 646                 if (tuple.TupleData[0] == CISTPL_FUNCE_LAN_NODE_ID)
 647                         break;
 648                 res = pcmcia_get_next_tuple(bus->host_pcmcia, &tuple);
 649                 GOTO_ERROR_ON(res != CS_SUCCESS, "MAC next tpl");
 650                 res = pcmcia_get_tuple_data(bus->host_pcmcia, &tuple);
 651                 GOTO_ERROR_ON(res != CS_SUCCESS, "MAC next tpl data");
 652         }
 653         GOTO_ERROR_ON(tuple.TupleDataLen != ETH_ALEN + 2, "MAC tpl size");
 654         memcpy(sprom->il0mac, &tuple.TupleData[2], ETH_ALEN);
 655
 656         /* Fetch the vendor specific tuples. */
 657         memset(&tuple, 0, sizeof(tuple));
 658         tuple.DesiredTuple = SSB_PCMCIA_CIS;
 659         tuple.TupleData = buf;
 660         tuple.TupleDataMax = sizeof(buf);
 661         res = pcmcia_get_first_tuple(bus->host_pcmcia, &tuple);
 662         GOTO_ERROR_ON(res != CS_SUCCESS, "VEN first tpl");
 663         res = pcmcia_get_tuple_data(bus->host_pcmcia, &tuple);
 664         GOTO_ERROR_ON(res != CS_SUCCESS, "VEN first tpl data");
 665         while (1) {
 666                 GOTO_ERROR_ON(tuple.TupleDataLen < 1, "VEN tpl < 1");
 667                 switch (tuple.TupleData[0]) {
 668                 case SSB_PCMCIA_CIS_ID:
 669                         GOTO_ERROR_ON((tuple.TupleDataLen != 5) &&
 670                                       (tuple.TupleDataLen != 7),
 671                                       "id tpl size");
 672                         bi->vendor = tuple.TupleData[1] |
 673                                ((u16)tuple.TupleData[2] << 8);
 674                         break;
 675                 case SSB_PCMCIA_CIS_BOARDREV:
 676                         GOTO_ERROR_ON(tuple.TupleDataLen != 2,
 677                                       "boardrev tpl size");
 678                         sprom->board_rev = tuple.TupleData[1];
 679                         break;
 680                 case SSB_PCMCIA_CIS_PA:
 681                         GOTO_ERROR_ON(tuple.TupleDataLen != 9,
 682                                       "pa tpl size");
 683                         sprom->pa0b0 = tuple.TupleData[1] |
 684                                  ((u16)tuple.TupleData[2] << 8);
 685                         sprom->pa0b1 = tuple.TupleData[3] |
 686                                  ((u16)tuple.TupleData[4] << 8);
 687                         sprom->pa0b2 = tuple.TupleData[5] |
 688                                  ((u16)tuple.TupleData[6] << 8);
 689                         sprom->itssi_a = tuple.TupleData[7];
 690                         sprom->itssi_bg = tuple.TupleData[7];
 691                         sprom->maxpwr_a = tuple.TupleData[8];
 692                         sprom->maxpwr_bg = tuple.TupleData[8];
 693                         break;
 694                 case SSB_PCMCIA_CIS_OEMNAME:
 695                         /* We ignore this. */
 696                         break;
 697                 case SSB_PCMCIA_CIS_CCODE:
 698                         GOTO_ERROR_ON(tuple.TupleDataLen != 2,
 699                                       "ccode tpl size");
 700                         sprom->country_code = tuple.TupleData[1];
 701                         break;
 702                 case SSB_PCMCIA_CIS_ANTENNA:
 703                         GOTO_ERROR_ON(tuple.TupleDataLen != 2,
 704                                       "ant tpl size");
 705                         sprom->ant_available_a = tuple.TupleData[1];
 706                         sprom->ant_available_bg = tuple.TupleData[1];
 707                         break;
 708                 case SSB_PCMCIA_CIS_ANTGAIN:
 709                         GOTO_ERROR_ON(tuple.TupleDataLen != 2,
 710                                       "antg tpl size");
 711                         sprom->antenna_gain.ghz24.a0 = tuple.TupleData[1];
 712                         sprom->antenna_gain.ghz24.a1 = tuple.TupleData[1];
 713                         sprom->antenna_gain.ghz24.a2 = tuple.TupleData[1];
 714                         sprom->antenna_gain.ghz24.a3 = tuple.TupleData[1];
 715                         sprom->antenna_gain.ghz5.a0 = tuple.TupleData[1];
 716                         sprom->antenna_gain.ghz5.a1 = tuple.TupleData[1];
 717                         sprom->antenna_gain.ghz5.a2 = tuple.TupleData[1];
 718                         sprom->antenna_gain.ghz5.a3 = tuple.TupleData[1];
 719                         break;
 720                 case SSB_PCMCIA_CIS_BFLAGS:
 721                         GOTO_ERROR_ON(tuple.TupleDataLen != 3,
 722                                       "bfl tpl size");
 723                         sprom->boardflags_lo = tuple.TupleData[1] |
 724                                          ((u16)tuple.TupleData[2] << 8);
 725                         break;
 726                 case SSB_PCMCIA_CIS_LEDS:
 727                         GOTO_ERROR_ON(tuple.TupleDataLen != 5,
 728                                       "leds tpl size");
 729                         sprom->gpio0 = tuple.TupleData[1];
 730                         sprom->gpio1 = tuple.TupleData[2];
 731                         sprom->gpio2 = tuple.TupleData[3];
 732                         sprom->gpio3 = tuple.TupleData[4];
 733                         break;
 734                 }
 735                 res = pcmcia_get_next_tuple(bus->host_pcmcia, &tuple);
 736                 if (res == CS_NO_MORE_ITEMS)
 737                         break;
 738                 GOTO_ERROR_ON(res != CS_SUCCESS, "VEN next tpl");
 739                 res = pcmcia_get_tuple_data(bus->host_pcmcia, &tuple);
 740                 GOTO_ERROR_ON(res != CS_SUCCESS, "VEN next tpl data");
 741         }
 742
 743         return 0;
 744 error:
 745         ssb_printk(KERN_ERR PFX
 746                    "PCMCIA: Failed to fetch device invariants: %s\n",
 747                    error_description);
 748         return -ENODEV;
 749 }
 750
 751 static ssize_t ssb_pcmcia_attr_sprom_show(struct device *pcmciadev,
 752                                           struct device_attribute *attr,
 753                                           char *buf)
 754 {
 755         struct pcmcia_device *pdev =
 756                 container_of(pcmciadev, struct pcmcia_device, dev);
 757         struct ssb_bus *bus;
 758
 759         bus = ssb_pcmcia_dev_to_bus(pdev);
 760         if (!bus)
 761                 return -ENODEV;
 762
 763         return ssb_attr_sprom_show(bus, buf,
 764                                    ssb_pcmcia_sprom_read_all);
 765 }
 766
 767 static ssize_t ssb_pcmcia_attr_sprom_store(struct device *pcmciadev,
 768                                            struct device_attribute *attr,
 769                                            const char *buf, size_t count)
 770 {
 771         struct pcmcia_device *pdev =
 772                 container_of(pcmciadev, struct pcmcia_device, dev);
 773         struct ssb_bus *bus;
 774
 775         bus = ssb_pcmcia_dev_to_bus(pdev);
 776         if (!bus)
 777                 return -ENODEV;
 778
 779         return ssb_attr_sprom_store(bus, buf, count,
 780                                     ssb_pcmcia_sprom_check_crc,
 781                                     ssb_pcmcia_sprom_write_all);
 782 }
 783
 784 static DEVICE_ATTR(ssb_sprom, 0600,
 785                    ssb_pcmcia_attr_sprom_show,
 786                    ssb_pcmcia_attr_sprom_store);
 787
 788 static int ssb_pcmcia_cor_setup(struct ssb_bus *bus, u8 cor)
 789 {
 790         u8 val;
 791         int err;
 792
 793         err = ssb_pcmcia_cfg_read(bus, cor, &val);
 794         if (err)
 795                 return err;
 796         val &= ~COR_SOFT_RESET;
 797         val |= COR_FUNC_ENA | COR_IREQ_ENA | COR_LEVEL_REQ;
 798         err = ssb_pcmcia_cfg_write(bus, cor, val);
 799         if (err)
 800                 return err;
 801         msleep(40);
 802
 803         return 0;
 804 }
 805
 806 /* Initialize the PCMCIA hardware. This is called on Init and Resume. */
 807 int ssb_pcmcia_hardware_setup(struct ssb_bus *bus)
 808 {
 809         int err;
 810
 811         if (bus->bustype != SSB_BUSTYPE_PCMCIA)
 812                 return 0;
 813
 814         /* Switch segment to a known state and sync
 815          * bus->mapped_pcmcia_seg with hardware state. */
 816         ssb_pcmcia_switch_segment(bus, 0);
 817         /* Init the COR register. */
 818         err = ssb_pcmcia_cor_setup(bus, CISREG_COR);
 819         if (err)
 820                 return err;
 821         /* Some cards also need this register to get poked. */
 822         err = ssb_pcmcia_cor_setup(bus, CISREG_COR + 0x80);
 823         if (err)
 824                 return err;
 825
 826         return 0;
 827 }
 828
 829 void ssb_pcmcia_exit(struct ssb_bus *bus)
 830 {
 831         if (bus->bustype != SSB_BUSTYPE_PCMCIA)
 832                 return;
 833
 834         device_remove_file(&bus->host_pcmcia->dev, &dev_attr_ssb_sprom);
 835 }
 836
 837 int ssb_pcmcia_init(struct ssb_bus *bus)
 838 {
 839         int err;
 840
 841         if (bus->bustype != SSB_BUSTYPE_PCMCIA)
 842                 return 0;
 843
 844         err = ssb_pcmcia_hardware_setup(bus);
 845         if (err)
 846                 goto error;
 847
 848         bus->sprom_size = SSB_PCMCIA_SPROM_SIZE;
 849         mutex_init(&bus->sprom_mutex);
 850         err = device_create_file(&bus->host_pcmcia->dev, &dev_attr_ssb_sprom);
 851         if (err)
 852                 goto error;
 853
 854         return 0;
 855 error:
 856         ssb_printk(KERN_ERR PFX "Failed to initialize PCMCIA host device\n");
 857         return err;
 858 }