mirror of
https://github.com/AuxXxilium/linux_dsm_epyc7002.git
synced 2024-11-24 17:30:53 +07:00
mtd: docg3: add suspend and resume
Add functions to powerdown and powerup from suspend, in order to save power. Signed-off-by: Robert Jarzmik <robert.jarzmik@free.fr> Reviewed-by: Ivan Djelic <ivan.djelic@parrot.com> Reviewed-by: Mike Dunn <mikedunn@newsguy.com> Signed-off-by: David Woodhouse <David.Woodhouse@intel.com>
This commit is contained in:
parent
d13d19ece3
commit
e4b2a96aeb
@ -45,7 +45,6 @@
|
||||
* As no specification is available from M-Systems/Sandisk, this drivers lacks
|
||||
* several functions available on the chip, as :
|
||||
* - IPL write
|
||||
* - powerdown / powerup
|
||||
*
|
||||
* The bus data width (8bits versus 16bits) is not handled (if_cfg flag), and
|
||||
* the driver assumes a 16bits data bus.
|
||||
@ -1755,6 +1754,78 @@ static void doc_release_device(struct mtd_info *mtd)
|
||||
kfree(mtd);
|
||||
}
|
||||
|
||||
/**
|
||||
* docg3_resume - Awakens docg3 floor
|
||||
* @pdev: platfrom device
|
||||
*
|
||||
* Returns 0 (always successfull)
|
||||
*/
|
||||
static int docg3_resume(struct platform_device *pdev)
|
||||
{
|
||||
int i;
|
||||
struct mtd_info **docg3_floors, *mtd;
|
||||
struct docg3 *docg3;
|
||||
|
||||
docg3_floors = platform_get_drvdata(pdev);
|
||||
mtd = docg3_floors[0];
|
||||
docg3 = mtd->priv;
|
||||
|
||||
doc_dbg("docg3_resume()\n");
|
||||
for (i = 0; i < 12; i++)
|
||||
doc_readb(docg3, DOC_IOSPACE_IPL);
|
||||
return 0;
|
||||
}
|
||||
|
||||
/**
|
||||
* docg3_suspend - Put in low power mode the docg3 floor
|
||||
* @pdev: platform device
|
||||
* @state: power state
|
||||
*
|
||||
* Shuts off most of docg3 circuitery to lower power consumption.
|
||||
*
|
||||
* Returns 0 if suspend succeeded, -EIO if chip refused suspend
|
||||
*/
|
||||
static int docg3_suspend(struct platform_device *pdev, pm_message_t state)
|
||||
{
|
||||
int floor, i;
|
||||
struct mtd_info **docg3_floors, *mtd;
|
||||
struct docg3 *docg3;
|
||||
u8 ctrl, pwr_down;
|
||||
|
||||
docg3_floors = platform_get_drvdata(pdev);
|
||||
for (floor = 0; floor < DOC_MAX_NBFLOORS; floor++) {
|
||||
mtd = docg3_floors[floor];
|
||||
if (!mtd)
|
||||
continue;
|
||||
docg3 = mtd->priv;
|
||||
|
||||
doc_writeb(docg3, floor, DOC_DEVICESELECT);
|
||||
ctrl = doc_register_readb(docg3, DOC_FLASHCONTROL);
|
||||
ctrl &= ~DOC_CTRL_VIOLATION & ~DOC_CTRL_CE;
|
||||
doc_writeb(docg3, ctrl, DOC_FLASHCONTROL);
|
||||
|
||||
for (i = 0; i < 10; i++) {
|
||||
usleep_range(3000, 4000);
|
||||
pwr_down = doc_register_readb(docg3, DOC_POWERMODE);
|
||||
if (pwr_down & DOC_POWERDOWN_READY)
|
||||
break;
|
||||
}
|
||||
if (pwr_down & DOC_POWERDOWN_READY) {
|
||||
doc_dbg("docg3_suspend(): floor %d powerdown ok\n",
|
||||
floor);
|
||||
} else {
|
||||
doc_err("docg3_suspend(): floor %d powerdown failed\n",
|
||||
floor);
|
||||
return -EIO;
|
||||
}
|
||||
}
|
||||
|
||||
mtd = docg3_floors[0];
|
||||
docg3 = mtd->priv;
|
||||
doc_set_asic_mode(docg3, DOC_ASICMODE_POWERDOWN);
|
||||
return 0;
|
||||
}
|
||||
|
||||
/**
|
||||
* doc_probe - Probe the IO space for a DiskOnChip G3 chip
|
||||
* @pdev: platform device
|
||||
@ -1860,6 +1931,8 @@ static struct platform_driver g3_driver = {
|
||||
.name = "docg3",
|
||||
.owner = THIS_MODULE,
|
||||
},
|
||||
.suspend = docg3_suspend,
|
||||
.resume = docg3_resume,
|
||||
.remove = __exit_p(docg3_release),
|
||||
};
|
||||
|
||||
|
@ -127,6 +127,7 @@
|
||||
|
||||
#define DOC_ASICMODECONFIRM 0x1072
|
||||
#define DOC_CHIPID_INV 0x1074
|
||||
#define DOC_POWERMODE 0x107c
|
||||
|
||||
/*
|
||||
* Flash sequences
|
||||
@ -238,6 +239,11 @@
|
||||
#define DOC_READADDR_ONE_BYTE 0x4000
|
||||
#define DOC_READADDR_ADDR_MASK 0x1fff
|
||||
|
||||
/*
|
||||
* Flash register : DOC_POWERMODE
|
||||
*/
|
||||
#define DOC_POWERDOWN_READY 0x80
|
||||
|
||||
/*
|
||||
* Status of erase and write operation
|
||||
*/
|
||||
|
Loading…
Reference in New Issue
Block a user