From f3fba5665b066615a39d157a4a4970824695b91d Mon Sep 17 00:00:00 2001 From: Hans de Goede Date: Tue, 25 Nov 2014 16:37:52 +0100 Subject: sun6i: axp221: Add axp221_get_sid function For sun6i the SID is stored in the pmic, rather then in the SoC itself, add a function to retreive the sid. Signed-off-by: Hans de Goede Acked-by: Ian Campbell --- drivers/power/axp221.c | 27 +++++++++++++++++++++++++++ 1 file changed, 27 insertions(+) (limited to 'drivers/power/axp221.c') diff --git a/drivers/power/axp221.c b/drivers/power/axp221.c index 941193a..826567a 100644 --- a/drivers/power/axp221.c +++ b/drivers/power/axp221.c @@ -184,3 +184,30 @@ int axp221_init(void) return 0; } + +int axp221_get_sid(unsigned int *sid) +{ + u8 *dest = (u8 *)sid; + int i, ret; + + ret = axp221_init(); + if (ret) + return ret; + + ret = p2wi_write(AXP221_PAGE, 1); + if (ret) + return ret; + + for (i = 0; i < 16; i++) { + ret = p2wi_read(AXP221_SID + i, &dest[i]); + if (ret) + return ret; + } + + p2wi_write(AXP221_PAGE, 0); + + for (i = 0; i < 4; i++) + sid[i] = be32_to_cpu(sid[i]); + + return 0; +} -- cgit v1.1