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