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

Save and restore the GPIOs on the macio for suspend/resume.

Browse Source
This commit is contained in:
Justin Hibbits 2014-01-11 06:35:29 +00:00
parent 176666c2c9
commit e68afcedbc
2 changed files with 48 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

44
sys/powerpc/powermac/macgpio.c
View File

@ -59,6 +59,9 @@ struct macgpio_softc {
phandle_t sc_node;
struct resource *sc_gpios;
int sc_gpios_rid;
uint32_t sc_saved_gpio_levels[2];
uint32_t sc_saved_gpios[GPIO_COUNT];
uint32_t sc_saved_extint_gpios[GPIO_EXTINT_COUNT];
};
static MALLOC_DEFINE(M_MACGPIO, "macgpio", "macgpio device information");
@ -74,6 +77,8 @@ static int macgpio_activate_resource(device_t, device_t, int, int,
static int macgpio_deactivate_resource(device_t, device_t, int, int,
struct resource *);
static ofw_bus_get_devinfo_t macgpio_get_devinfo;
static int macgpio_suspend(device_t dev);
static int macgpio_resume(device_t dev);
/*
* Bus interface definition
@ -84,8 +89,8 @@ static device_method_t macgpio_methods[] = {
DEVMETHOD(device_attach, macgpio_attach),
DEVMETHOD(device_detach, bus_generic_detach),
DEVMETHOD(device_shutdown, bus_generic_shutdown),
DEVMETHOD(device_suspend, bus_generic_suspend),
DEVMETHOD(device_resume, bus_generic_resume),
DEVMETHOD(device_suspend, macgpio_suspend),
DEVMETHOD(device_resume, macgpio_resume),
/* Bus interface */
DEVMETHOD(bus_print_child, macgpio_print_child),
@ -361,3 +366,38 @@ macgpio_get_devinfo(device_t dev, device_t child)
return (&dinfo->mdi_obdinfo);
}
static int
macgpio_suspend(device_t dev)
{
struct macgpio_softc *sc;
int i;
sc = device_get_softc(dev);
sc->sc_saved_gpio_levels[0] = bus_read_4(sc->sc_gpios, GPIO_LEVELS_0);
sc->sc_saved_gpio_levels[1] = bus_read_4(sc->sc_gpios, GPIO_LEVELS_1);
for (i = 0; i < GPIO_COUNT; i++)
sc->sc_saved_gpios[i] = bus_read_1(sc->sc_gpios, GPIO_BASE + i);
for (i = 0; i < GPIO_EXTINT_COUNT; i++)
sc->sc_saved_extint_gpios[i] = bus_read_1(sc->sc_gpios, GPIO_EXTINT_BASE + i);
return (0);
}
static int
macgpio_resume(device_t dev)
{
struct macgpio_softc *sc;
int i;
sc = device_get_softc(dev);
bus_write_4(sc->sc_gpios, GPIO_LEVELS_0, sc->sc_saved_gpio_levels[0]);
bus_write_4(sc->sc_gpios, GPIO_LEVELS_1, sc->sc_saved_gpio_levels[1]);
for (i = 0; i < GPIO_COUNT; i++)
bus_write_1(sc->sc_gpios, GPIO_BASE + i, sc->sc_saved_gpios[i]);
for (i = 0; i < GPIO_EXTINT_COUNT; i++)
bus_write_1(sc->sc_gpios, GPIO_EXTINT_BASE + i, sc->sc_saved_extint_gpios[i]);
return (0);
}

6
sys/powerpc/powermac/macgpiovar.h
View File

@ -32,6 +32,12 @@
#define GPIO_EXTINT_BASE 0x08
#define GPIO_BASE 0x1a
#define GPIO_EXTINT_COUNT 0x12
#define GPIO_COUNT 0x11
#define GPIO_LEVELS_0 0x50
#define GPIO_LEVELS_1 0x54
/* gpio bit definitions */
#define GPIO_DATA 0x01 /* GPIO data */
#define GPIO_LEVEL_RO 0x02 /* read-only level on pin */