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