root/drivers/ssb/driver_chipcommon_sflash.c

DEFINITIONS

1. ssb_sflash_cmd
2. ssb_sflash_init

   1 /*
   2  * Sonics Silicon Backplane
   3  * ChipCommon serial flash interface
   4  *
   5  * Licensed under the GNU/GPL. See COPYING for details.
   6  */
   7 
   8 #include "ssb_private.h"
   9 
  10 #include <linux/ssb/ssb.h>
  11 
  12 static struct resource ssb_sflash_resource = {
  13         .name   = "ssb_sflash",
  14         .start  = SSB_FLASH2,
  15         .end    = 0,
  16         .flags  = IORESOURCE_MEM | IORESOURCE_READONLY,
  17 };
  18 
  19 struct platform_device ssb_sflash_dev = {
  20         .name           = "ssb_sflash",
  21         .resource       = &ssb_sflash_resource,
  22         .num_resources  = 1,
  23 };
  24 
  25 struct ssb_sflash_tbl_e {
  26         char *name;
  27         u32 id;
  28         u32 blocksize;
  29         u16 numblocks;
  30 };
  31 
  32 static const struct ssb_sflash_tbl_e ssb_sflash_st_tbl[] = {
  33         { "M25P20", 0x11, 0x10000, 4, },
  34         { "M25P40", 0x12, 0x10000, 8, },
  35 
  36         { "M25P16", 0x14, 0x10000, 32, },
  37         { "M25P32", 0x15, 0x10000, 64, },
  38         { "M25P64", 0x16, 0x10000, 128, },
  39         { "M25FL128", 0x17, 0x10000, 256, },
  40         { NULL },
  41 };
  42 
  43 static const struct ssb_sflash_tbl_e ssb_sflash_sst_tbl[] = {
  44         { "SST25WF512", 1, 0x1000, 16, },
  45         { "SST25VF512", 0x48, 0x1000, 16, },
  46         { "SST25WF010", 2, 0x1000, 32, },
  47         { "SST25VF010", 0x49, 0x1000, 32, },
  48         { "SST25WF020", 3, 0x1000, 64, },
  49         { "SST25VF020", 0x43, 0x1000, 64, },
  50         { "SST25WF040", 4, 0x1000, 128, },
  51         { "SST25VF040", 0x44, 0x1000, 128, },
  52         { "SST25VF040B", 0x8d, 0x1000, 128, },
  53         { "SST25WF080", 5, 0x1000, 256, },
  54         { "SST25VF080B", 0x8e, 0x1000, 256, },
  55         { "SST25VF016", 0x41, 0x1000, 512, },
  56         { "SST25VF032", 0x4a, 0x1000, 1024, },
  57         { "SST25VF064", 0x4b, 0x1000, 2048, },
  58         { NULL },
  59 };
  60 
  61 static const struct ssb_sflash_tbl_e ssb_sflash_at_tbl[] = {
  62         { "AT45DB011", 0xc, 256, 512, },
  63         { "AT45DB021", 0x14, 256, 1024, },
  64         { "AT45DB041", 0x1c, 256, 2048, },
  65         { "AT45DB081", 0x24, 256, 4096, },
  66         { "AT45DB161", 0x2c, 512, 4096, },
  67         { "AT45DB321", 0x34, 512, 8192, },
  68         { "AT45DB642", 0x3c, 1024, 8192, },
  69         { NULL },
  70 };
  71 
  72 static void ssb_sflash_cmd(struct ssb_chipcommon *cc, u32 opcode)
  73 {
  74         int i;
  75         chipco_write32(cc, SSB_CHIPCO_FLASHCTL,
  76                        SSB_CHIPCO_FLASHCTL_START | opcode);
  77         for (i = 0; i < 1000; i++) {
  78                 if (!(chipco_read32(cc, SSB_CHIPCO_FLASHCTL) &
  79                       SSB_CHIPCO_FLASHCTL_BUSY))
  80                         return;
  81                 cpu_relax();
  82         }
  83         dev_err(cc->dev->dev, "SFLASH control command failed (timeout)!\n");
  84 }
  85 
  86 /* Initialize serial flash access */
  87 int ssb_sflash_init(struct ssb_chipcommon *cc)
  88 {
  89         struct ssb_sflash *sflash = &cc->dev->bus->mipscore.sflash;
  90         const struct ssb_sflash_tbl_e *e;
  91         u32 id, id2;
  92 
  93         switch (cc->capabilities & SSB_CHIPCO_CAP_FLASHT) {
  94         case SSB_CHIPCO_FLASHT_STSER:
  95                 ssb_sflash_cmd(cc, SSB_CHIPCO_FLASHCTL_ST_DP);
  96 
  97                 chipco_write32(cc, SSB_CHIPCO_FLASHADDR, 0);
  98                 ssb_sflash_cmd(cc, SSB_CHIPCO_FLASHCTL_ST_RES);
  99                 id = chipco_read32(cc, SSB_CHIPCO_FLASHDATA);
 100 
 101                 chipco_write32(cc, SSB_CHIPCO_FLASHADDR, 1);
 102                 ssb_sflash_cmd(cc, SSB_CHIPCO_FLASHCTL_ST_RES);
 103                 id2 = chipco_read32(cc, SSB_CHIPCO_FLASHDATA);
 104 
 105                 switch (id) {
 106                 case 0xbf:
 107                         for (e = ssb_sflash_sst_tbl; e->name; e++) {
 108                                 if (e->id == id2)
 109                                         break;
 110                         }
 111                         break;
 112                 case 0x13:
 113                         return -ENOTSUPP;
 114                 default:
 115                         for (e = ssb_sflash_st_tbl; e->name; e++) {
 116                                 if (e->id == id)
 117                                         break;
 118                         }
 119                         break;
 120                 }
 121                 if (!e->name) {
 122                         pr_err("Unsupported ST serial flash (id: 0x%X, id2: 0x%X)\n",
 123                                id, id2);
 124                         return -ENOTSUPP;
 125                 }
 126 
 127                 break;
 128         case SSB_CHIPCO_FLASHT_ATSER:
 129                 ssb_sflash_cmd(cc, SSB_CHIPCO_FLASHCTL_AT_STATUS);
 130                 id = chipco_read32(cc, SSB_CHIPCO_FLASHDATA) & 0x3c;
 131 
 132                 for (e = ssb_sflash_at_tbl; e->name; e++) {
 133                         if (e->id == id)
 134                                 break;
 135                 }
 136                 if (!e->name) {
 137                         pr_err("Unsupported Atmel serial flash (id: 0x%X)\n",
 138                                id);
 139                         return -ENOTSUPP;
 140                 }
 141 
 142                 break;
 143         default:
 144                 pr_err("Unsupported flash type\n");
 145                 return -ENOTSUPP;
 146         }
 147 
 148         sflash->window = SSB_FLASH2;
 149         sflash->blocksize = e->blocksize;
 150         sflash->numblocks = e->numblocks;
 151         sflash->size = sflash->blocksize * sflash->numblocks;
 152         sflash->present = true;
 153 
 154         pr_info("Found %s serial flash (size: %dKiB, blocksize: 0x%X, blocks: %d)\n",
 155                 e->name, sflash->size / 1024, e->blocksize, e->numblocks);
 156 
 157         /* Prepare platform device, but don't register it yet. It's too early,
 158          * malloc (required by device_private_init) is not available yet. */
 159         ssb_sflash_dev.resource[0].end = ssb_sflash_dev.resource[0].start +
 160                                          sflash->size;
 161         ssb_sflash_dev.dev.platform_data = sflash;
 162 
 163         return 0;
 164 }