[MTD] [NAND] Resume method for CAFÉ NAND controller
Originally from Marcelo; modified to put the original timing registers back instead of 0xFFFFFFFF. Signed-off-by: David Woodhouse <dwmw2@infradead.org>
This commit is contained in:
@@ -827,15 +827,51 @@ static struct pci_device_id cafe_nand_tbl[] = {
|
|||||||
|
|
||||||
MODULE_DEVICE_TABLE(pci, cafe_nand_tbl);
|
MODULE_DEVICE_TABLE(pci, cafe_nand_tbl);
|
||||||
|
|
||||||
|
static int cafe_nand_resume(struct pci_dev *pdev)
|
||||||
|
{
|
||||||
|
uint32_t ctrl;
|
||||||
|
struct mtd_info *mtd = pci_get_drvdata(pdev);
|
||||||
|
struct cafe_priv *cafe = mtd->priv;
|
||||||
|
|
||||||
|
/* Start off by resetting the NAND controller completely */
|
||||||
|
cafe_writel(cafe, 1, NAND_RESET);
|
||||||
|
cafe_writel(cafe, 0, NAND_RESET);
|
||||||
|
cafe_writel(cafe, 0xffffffff, NAND_IRQ_MASK);
|
||||||
|
|
||||||
|
/* Restore timing configuration */
|
||||||
|
cafe_writel(cafe, timing[0], NAND_TIMING1);
|
||||||
|
cafe_writel(cafe, timing[1], NAND_TIMING2);
|
||||||
|
cafe_writel(cafe, timing[2], NAND_TIMING3);
|
||||||
|
|
||||||
|
/* Disable master reset, enable NAND clock */
|
||||||
|
ctrl = cafe_readl(cafe, GLOBAL_CTRL);
|
||||||
|
ctrl &= 0xffffeff0;
|
||||||
|
ctrl |= 0x00007000;
|
||||||
|
cafe_writel(cafe, ctrl | 0x05, GLOBAL_CTRL);
|
||||||
|
cafe_writel(cafe, ctrl | 0x0a, GLOBAL_CTRL);
|
||||||
|
cafe_writel(cafe, 0, NAND_DMA_CTRL);
|
||||||
|
cafe_writel(cafe, 0x7006, GLOBAL_CTRL);
|
||||||
|
cafe_writel(cafe, 0x700a, GLOBAL_CTRL);
|
||||||
|
|
||||||
|
/* Set up DMA address */
|
||||||
|
cafe_writel(cafe, cafe->dmaaddr & 0xffffffff, NAND_DMA_ADDR0);
|
||||||
|
if (sizeof(cafe->dmaaddr) > 4)
|
||||||
|
/* Shift in two parts to shut the compiler up */
|
||||||
|
cafe_writel(cafe, (cafe->dmaaddr >> 16) >> 16, NAND_DMA_ADDR1);
|
||||||
|
else
|
||||||
|
cafe_writel(cafe, 0, NAND_DMA_ADDR1);
|
||||||
|
|
||||||
|
/* Enable NAND IRQ in global IRQ mask register */
|
||||||
|
cafe_writel(cafe, 0x80000007, GLOBAL_IRQ_MASK);
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
static struct pci_driver cafe_nand_pci_driver = {
|
static struct pci_driver cafe_nand_pci_driver = {
|
||||||
.name = "CAFÉ NAND",
|
.name = "CAFÉ NAND",
|
||||||
.id_table = cafe_nand_tbl,
|
.id_table = cafe_nand_tbl,
|
||||||
.probe = cafe_nand_probe,
|
.probe = cafe_nand_probe,
|
||||||
.remove = __devexit_p(cafe_nand_remove),
|
.remove = __devexit_p(cafe_nand_remove),
|
||||||
#ifdef CONFIG_PMx
|
|
||||||
.suspend = cafe_nand_suspend,
|
|
||||||
.resume = cafe_nand_resume,
|
.resume = cafe_nand_resume,
|
||||||
#endif
|
|
||||||
};
|
};
|
||||||
|
|
||||||
static int cafe_nand_init(void)
|
static int cafe_nand_init(void)
|
||||||
|
Reference in New Issue
Block a user