d/freebsd-nq
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

rk805: add system poweroff support

Browse Source 
On my Rock64 neither EFI nor PSCI shutdown actually power off the board.
RK805 does the job.

Reviewed by:	manu, peterj
Differential Revision:	https://reviews.freebsd.org/D30786
This commit is contained in:
Andriy Gapon 2021-11-06 19:58:43 +02:00
parent 2d1de2d553
commit cc0b35259a
2 changed files with 40 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

36
sys/arm64/rockchip/rk805.c
View File

@ -31,8 +31,10 @@ __FBSDID("$FreeBSD$");
#include <sys/param.h> #include <sys/param.h>
#include <sys/bus.h> #include <sys/bus.h>
#include <sys/clock.h> #include <sys/clock.h>
#include <sys/eventhandler.h>
#include <sys/kernel.h> #include <sys/kernel.h>
#include <sys/module.h> #include <sys/module.h>
#include <sys/reboot.h>
#include <sys/mutex.h> #include <sys/mutex.h>
#include <sys/rman.h> #include <sys/rman.h>
#include <machine/bus.h> #include <machine/bus.h>
@ -844,6 +846,29 @@ rk805_settime(device_t dev, struct timespec *ts)
return (error); return (error);
} }
static void
rk805_poweroff(void *arg, int howto)
{
device_t dev = arg;
int error;
uint8_t val;
if ((howto & RB_POWEROFF) == 0)
return;
device_printf(dev, "Powering off...\n");
error = rk805_read(dev, RK805_DEV_CTRL, &val, 1);
if (error == 0) {
val |= RK805_DEV_CTRL_OFF;
error = rk805_write(dev, RK805_DEV_CTRL, &val, 1);
/* Wait a bit for the command to take effect. */
if (error == 0)
DELAY(100);
}
device_printf(dev, "Power off failed\n");
}
static int static int
rk805_attach(device_t dev) rk805_attach(device_t dev)
{ {
@ -907,6 +932,17 @@ rk805_attach(device_t dev)
} }
} }
if (OF_hasprop(ofw_bus_get_node(dev),
"rockchip,system-power-controller")) {
/*
* The priority is chosen to override PSCI and EFI shutdown
* methods as those two just hang without powering off on Rock64
* at least.
*/
EVENTHANDLER_REGISTER(shutdown_final, rk805_poweroff, dev,
SHUTDOWN_PRI_LAST - 2);
}
return (0); return (0);
} }

4
sys/arm64/rockchip/rk805reg.h
View File

@ -93,6 +93,10 @@
#define RK808_LDO8_ON_VSEL 0x49 #define RK808_LDO8_ON_VSEL 0x49
#define RK808_LDO8_SLEEP_VSEL 0x4A #define RK808_LDO8_SLEEP_VSEL 0x4A
#define RK805_DEV_CTRL 0x4B
#define RK805_DEV_CTRL_OFF (1 << 0)
#define RK805_DEV_CTRL_SLP (1 << 1)
enum rk805_regulator { enum rk805_regulator {
RK805_DCDC1 = 0, RK805_DCDC1 = 0,
RK805_DCDC2, RK805_DCDC2,