/* * Broadcom SiliconBackplane chipcommon serial flash interface * * Copyright 2001-2003, Broadcom Corporation * All Rights Reserved. * * THIS SOFTWARE IS OFFERED "AS IS", AND BROADCOM GRANTS NO WARRANTIES OF ANY * KIND, EXPRESS OR IMPLIED, BY STATUTE, COMMUNICATION OR OTHERWISE. BROADCOM * SPECIFICALLY DISCLAIMS ANY IMPLIED WARRANTIES OF MERCHANTABILITY, FITNESS * FOR A SPECIFIC PURPOSE OR NONINFRINGEMENT CONCERNING THIS SOFTWARE. * * $Id: sflash.c,v 1.1.1.3 2003/11/10 17:43:38 hyin Exp $ */ #include #include #include #include #include #include #include #include #include #include #include #ifdef CONFIG_MTD_PARTITIONS #include #include #include #include #include #include #include #endif #include #include #include #include #include #include #include #include #include #include #ifdef CONFIG_MTD_PARTITIONS extern struct mtd_partition * init_mtd_partitions(struct mtd_info *mtd, size_t size); #endif struct sflash_mtd { chipcregs_t *cc; struct semaphore lock; struct mtd_info mtd; struct mtd_erase_region_info regions[1]; }; /* Private global state */ static struct sflash_mtd sflash; static int sflash_mtd_poll(struct sflash_mtd *sflash, unsigned int offset, int timeout) { int now = jiffies; int ret = 0; for (;;) { if (!sflash_poll(sflash->cc, offset)) { ret = 0; break; } if (time_after(jiffies, now + timeout)) { printk(KERN_ERR "sflash: timeout\n"); ret = -ETIMEDOUT; break; } if (current->need_resched) { set_current_state(TASK_UNINTERRUPTIBLE); schedule_timeout(timeout / 10); } else udelay(1); } return ret; } static int sflash_mtd_read(struct mtd_info *mtd, loff_t from, size_t len, size_t *retlen, u_char *buf) { struct sflash_mtd *sflash = (struct sflash_mtd *) mtd->priv; int bytes, ret = 0; /* Check address range */ if (!len) return 0; if ((from + len) > mtd->size) return -EINVAL; down(&sflash->lock); *retlen = 0; while (len) { if ((bytes = sflash_read(sflash->cc, (uint) from, len, buf)) < 0) { ret = bytes; break; } from += (loff_t) bytes; len -= bytes; buf += bytes; *retlen += bytes; } up(&sflash->lock); return ret; } static int sflash_mtd_write(struct mtd_info *mtd, loff_t to, size_t len, size_t *retlen, const u_char *buf) { struct sflash_mtd *sflash = (struct sflash_mtd *) mtd->priv; int bytes, ret = 0; /* Check address range */ if (!len) return 0; if ((to + len) > mtd->size) return -EINVAL; down(&sflash->lock); *retlen = 0; while (len) { if ((bytes = sflash_write(sflash->cc, (uint) to, len, buf)) < 0) { ret = bytes; break; } if ((ret = sflash_mtd_poll(sflash, (unsigned int) to, HZ / 10))) break; to += (loff_t) bytes; len -= bytes; buf += bytes; *retlen += bytes; } up(&sflash->lock); return ret; } static int sflash_mtd_erase(struct mtd_info *mtd, struct erase_info *erase) { struct sflash_mtd *sflash = (struct sflash_mtd *) mtd->priv; int i, j, ret = 0; unsigned int addr, len; /* Check address range */ if (!erase->len) return 0; if ((erase->addr + erase->len) > mtd->size) return -EINVAL; addr = erase->addr; len = erase->len; down(&sflash->lock); /* Ensure that requested region is aligned */ for (i = 0; i < mtd->numeraseregions; i++) { for (j = 0; j < mtd->eraseregions[i].numblocks; j++) { if (addr == mtd->eraseregions[i].offset + mtd->eraseregions[i].erasesize * j && len >= mtd->eraseregions[i].erasesize) { if ((ret = sflash_erase(sflash->cc, addr)) < 0) break; if ((ret = sflash_mtd_poll(sflash, addr, 10 * HZ))) break; addr += mtd->eraseregions[i].erasesize; len -= mtd->eraseregions[i].erasesize; } } if (ret) break; } up(&sflash->lock); /* Set erase status */ if (ret) erase->state = MTD_ERASE_FAILED; else erase->state = MTD_ERASE_DONE; /* Call erase callback */ if (erase->callback) erase->callback(erase); return ret; } #if LINUX_VERSION_CODE < 0x20212 && defined(MODULE) #define sflash_mtd_init init_module #define sflash_mtd_exit cleanup_module #endif mod_init_t sflash_mtd_init(void) { struct pci_dev *pdev; int ret = 0; struct sflash *info; uint bank, i; #ifdef CONFIG_MTD_PARTITIONS struct mtd_partition *parts; #endif if (!(pdev = pci_find_device(VENDOR_BROADCOM, SB_CC, NULL))) { printk(KERN_ERR "sflash: chipcommon not found\n"); return -ENODEV; } memset(&sflash, 0, sizeof(struct sflash_mtd)); init_MUTEX(&sflash.lock); /* Map registers and flash base */ if (!(sflash.cc = ioremap_nocache(pci_resource_start(pdev, 0), pci_resource_len(pdev, 0)))) { printk(KERN_ERR "sflash: error mapping registers\n"); ret = -EIO; goto fail; } /* Initialize serial flash access */ info = sflash_init(sflash.cc); if (!info) { printk(KERN_ERR "sflash: found no supported devices\n"); ret = -ENODEV; goto fail; } /* Setup banks */ sflash.regions[0].offset = 0; sflash.regions[0].erasesize = info->blocksize; sflash.regions[0].numblocks = info->numblocks; if (sflash.regions[0].erasesize > sflash.mtd.erasesize) sflash.mtd.erasesize = sflash.regions[0].erasesize; if (sflash.regions[0].erasesize * sflash.regions[0].numblocks) { sflash.mtd.size += sflash.regions[0].erasesize * sflash.regions[0].numblocks; } sflash.mtd.numeraseregions = 1; ASSERT(sflash.mtd.size == info->size); /* Register with MTD */ sflash.mtd.name = "sflash"; sflash.mtd.type = MTD_NORFLASH; sflash.mtd.flags = MTD_CAP_NORFLASH; sflash.mtd.eraseregions = sflash.regions; sflash.mtd.module = THIS_MODULE; sflash.mtd.erase = sflash_mtd_erase; sflash.mtd.read = sflash_mtd_read; sflash.mtd.write = sflash_mtd_write; sflash.mtd.priv = &sflash; #ifdef CONFIG_MTD_PARTITIONS parts = init_mtd_partitions(&sflash.mtd, sflash.mtd.size); for (i = 0; parts[i].name; i++); ret = add_mtd_partitions(&sflash.mtd, parts, i); #else ret = add_mtd_device(&sflash.mtd); #endif if (ret) { printk(KERN_ERR "sflash: add_mtd failed\n"); goto fail; } return 0; fail: if (sflash.cc) iounmap((void *) sflash.cc); return ret; } mod_exit_t sflash_mtd_exit(void) { #ifdef CONFIG_MTD_PARTITIONS del_mtd_partitions(&sflash.mtd); #else del_mtd_device(&sflash.mtd); #endif iounmap((void *) sflash.cc); } module_init(sflash_mtd_init); module_exit(sflash_mtd_exit);