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 } 165