/*
 * Sonics Silicon Backplane
 * ChipCommon serial flash interface
 *
 * Licensed under the GNU/GPL. See COPYING for details.
 */

#include "ssb_private.h"

#include <linux/ssb/ssb.h>

static struct resource ssb_sflash_resource = {
        .name   = "ssb_sflash",
        .start  = SSB_FLASH2,
        .end    = 0,
        .flags  = IORESOURCE_MEM | IORESOURCE_READONLY,
};

struct platform_device ssb_sflash_dev = {
        .name           = "ssb_sflash",
        .resource       = &ssb_sflash_resource,
        .num_resources  = 1,
};

struct ssb_sflash_tbl_e {
        char *name;
        u32 id;
        u32 blocksize;
        u16 numblocks;
};

static const struct ssb_sflash_tbl_e ssb_sflash_st_tbl[] = {
        { "M25P20", 0x11, 0x10000, 4, },
        { "M25P40", 0x12, 0x10000, 8, },

        { "M25P16", 0x14, 0x10000, 32, },
        { "M25P32", 0x15, 0x10000, 64, },
        { "M25P64", 0x16, 0x10000, 128, },
        { "M25FL128", 0x17, 0x10000, 256, },
        { NULL },
};

static const struct ssb_sflash_tbl_e ssb_sflash_sst_tbl[] = {
        { "SST25WF512", 1, 0x1000, 16, },
        { "SST25VF512", 0x48, 0x1000, 16, },
        { "SST25WF010", 2, 0x1000, 32, },
        { "SST25VF010", 0x49, 0x1000, 32, },
        { "SST25WF020", 3, 0x1000, 64, },
        { "SST25VF020", 0x43, 0x1000, 64, },
        { "SST25WF040", 4, 0x1000, 128, },
        { "SST25VF040", 0x44, 0x1000, 128, },
        { "SST25VF040B", 0x8d, 0x1000, 128, },
        { "SST25WF080", 5, 0x1000, 256, },
        { "SST25VF080B", 0x8e, 0x1000, 256, },
        { "SST25VF016", 0x41, 0x1000, 512, },
        { "SST25VF032", 0x4a, 0x1000, 1024, },
        { "SST25VF064", 0x4b, 0x1000, 2048, },
        { NULL },
};

static const struct ssb_sflash_tbl_e ssb_sflash_at_tbl[] = {
        { "AT45DB011", 0xc, 256, 512, },
        { "AT45DB021", 0x14, 256, 1024, },
        { "AT45DB041", 0x1c, 256, 2048, },
        { "AT45DB081", 0x24, 256, 4096, },
        { "AT45DB161", 0x2c, 512, 4096, },
        { "AT45DB321", 0x34, 512, 8192, },
        { "AT45DB642", 0x3c, 1024, 8192, },
        { NULL },
};

static void ssb_sflash_cmd(struct ssb_chipcommon *cc, u32 opcode)
{
        int i;
        chipco_write32(cc, SSB_CHIPCO_FLASHCTL,
                       SSB_CHIPCO_FLASHCTL_START | opcode);
        for (i = 0; i < 1000; i++) {
                if (!(chipco_read32(cc, SSB_CHIPCO_FLASHCTL) &
                      SSB_CHIPCO_FLASHCTL_BUSY))
                        return;
                cpu_relax();
        }
        dev_err(cc->dev->dev, "SFLASH control command failed (timeout)!\n");
}

/* Initialize serial flash access */
int ssb_sflash_init(struct ssb_chipcommon *cc)
{
        struct ssb_sflash *sflash = &cc->dev->bus->mipscore.sflash;
        const struct ssb_sflash_tbl_e *e;
        u32 id, id2;

        switch (cc->capabilities & SSB_CHIPCO_CAP_FLASHT) {
        case SSB_CHIPCO_FLASHT_STSER:
                ssb_sflash_cmd(cc, SSB_CHIPCO_FLASHCTL_ST_DP);

                chipco_write32(cc, SSB_CHIPCO_FLASHADDR, 0);
                ssb_sflash_cmd(cc, SSB_CHIPCO_FLASHCTL_ST_RES);
                id = chipco_read32(cc, SSB_CHIPCO_FLASHDATA);

                chipco_write32(cc, SSB_CHIPCO_FLASHADDR, 1);
                ssb_sflash_cmd(cc, SSB_CHIPCO_FLASHCTL_ST_RES);
                id2 = chipco_read32(cc, SSB_CHIPCO_FLASHDATA);

                switch (id) {
                case 0xbf:
                        for (e = ssb_sflash_sst_tbl; e->name; e++) {
                                if (e->id == id2)
                                        break;
                        }
                        break;
                case 0x13:
                        return -ENOTSUPP;
                default:
                        for (e = ssb_sflash_st_tbl; e->name; e++) {
                                if (e->id == id)
                                        break;
                        }
                        break;
                }
                if (!e->name) {
                        pr_err("Unsupported ST serial flash (id: 0x%X, id2: 0x%X)\n",
                               id, id2);
                        return -ENOTSUPP;
                }

                break;
        case SSB_CHIPCO_FLASHT_ATSER:
                ssb_sflash_cmd(cc, SSB_CHIPCO_FLASHCTL_AT_STATUS);
                id = chipco_read32(cc, SSB_CHIPCO_FLASHDATA) & 0x3c;

                for (e = ssb_sflash_at_tbl; e->name; e++) {
                        if (e->id == id)
                                break;
                }
                if (!e->name) {
                        pr_err("Unsupported Atmel serial flash (id: 0x%X)\n",
                               id);
                        return -ENOTSUPP;
                }

                break;
        default:
                pr_err("Unsupported flash type\n");
                return -ENOTSUPP;
        }

        sflash->window = SSB_FLASH2;
        sflash->blocksize = e->blocksize;
        sflash->numblocks = e->numblocks;
        sflash->size = sflash->blocksize * sflash->numblocks;
        sflash->present = true;

        pr_info("Found %s serial flash (size: %dKiB, blocksize: 0x%X, blocks: %d)\n",
                e->name, sflash->size / 1024, e->blocksize, e->numblocks);

        /* Prepare platform device, but don't register it yet. It's too early,
         * malloc (required by device_private_init) is not available yet. */
        ssb_sflash_dev.resource[0].end = ssb_sflash_dev.resource[0].start +
                                         sflash->size;
        ssb_sflash_dev.dev.platform_data = sflash;

        return 0;
}