Mirrors/m1n1
2
0
Fork 0
mirror of https://github.com/AsahiLinux/m1n1 synced 2024-11-10 09:44:13 +00:00
Code Issues Projects Releases Packages Wiki Activity

pmgr: add pmgr_reset

Browse source 
Signed-off-by: Sven Peter <sven@svenpeter.dev>
This commit is contained in:
Sven Peter 2022-01-10 18:16:58 +01:00 committed by Hector Martin
parent 1254b4bee6
commit 1521978a6c
2 changed files with 35 additions and 0 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

33
src/pmgr.c
View file

@ -196,6 +196,39 @@ int pmgr_adt_power_disable(const char *path)
return pmgr_adt_devices_set_mode(path, PMGR_PS_PWRGATE, false);
}
int pmgr_reset(const char *name)
{
const struct pmgr_device *dev = NULL;
for (unsigned int i = 0; i < pmgr_devices_len; ++i) {
if (strncmp(pmgr_devices[i].name, name, 0x10) == 0) {
dev = &pmgr_devices[i];
break;
}
}
if (!dev) {
printf("pmgr: unable to find device %s\n", name);
return -1;
}
uintptr_t addr = pmgr_device_get_addr(dev);
u32 reg = read32(addr);
if (FIELD_GET(PMGR_PS_ACTUAL, reg) != PMGR_PS_ACTIVE) {
printf("pmgr: will not reset disabled device %s\n", name);
return -1;
}
set32(addr, PMGR_DEV_DISABLE);
set32(addr, PMGR_RESET);
udelay(1);
clear32(addr, PMGR_RESET);
clear32(addr, PMGR_DEV_DISABLE);
return 0;
}
int pmgr_init(void)
{
pmgr_offset = adt_path_offset_trace(adt, "/arm-io/pmgr", pmgr_path);

2
src/pmgr.h
View file

@ -13,4 +13,6 @@ int pmgr_power_disable(u16 id);
int pmgr_adt_power_enable(const char *path);
int pmgr_adt_power_disable(const char *path);
int pmgr_reset(const char *name);
#endif