cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

driver_chipcommon_sflash.c (4286B)

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