diff options
author | Hans de Goede <hdegoede@redhat.com> | 2014-11-25 16:37:52 +0100 |
---|---|---|
committer | Hans de Goede <hdegoede@redhat.com> | 2015-01-14 14:56:36 +0100 |
commit | f3fba5665b066615a39d157a4a4970824695b91d (patch) | |
tree | 92d99838c315cec480bb45f977869903bd616df5 /drivers/power | |
parent | fc3a832576ce7bb597b1823935bfb7dcca235c3c (diff) |
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 <hdegoede@redhat.com>
Acked-by: Ian Campbell <ijc@hellion.org.uk>
Diffstat (limited to 'drivers/power')
-rw-r--r-- | drivers/power/axp221.c | 27 |
1 files changed, 27 insertions, 0 deletions
diff --git a/drivers/power/axp221.c b/drivers/power/axp221.c index 941193a19da..826567a836b 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; +} |