diff options
Diffstat (limited to 'drivers/power/axp221.c')
| -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 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; +} |