Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 1fcf8ce5 authored by David Woodhouse's avatar David Woodhouse
Browse files

[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: default avatarDavid Woodhouse <dwmw2@infradead.org>
parent 06ed24e5

drivers/mtd/nand/cafe_nand.c

+39 −3
Original line number Original line Diff line number Diff line
@@ -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)