Author: jhibbits
Date: Sat Jan 11 06:35:29 2014
New Revision: 260533
URL: http://svnweb.freebsd.org/changeset/base/260533
Log:
Save and restore the GPIOs on the macio for suspend/resume.
Modified:
head/sys/powerpc/powermac/macgpio.c
head/sys/powerpc/powermac/macgpiovar.h
Modified: head/sys/powerpc/powermac/macgpio.c
==============================================================================
--- head/sys/powerpc/powermac/macgpio.c Sat Jan 11 04:22:00 2014
(r260532)
+++ head/sys/powerpc/powermac/macgpio.c Sat Jan 11 06:35:29 2014
(r260533)
@@ -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(dev
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
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);
+}
Modified: head/sys/powerpc/powermac/macgpiovar.h
==============================================================================
--- head/sys/powerpc/powermac/macgpiovar.h Sat Jan 11 04:22:00 2014
(r260532)
+++ head/sys/powerpc/powermac/macgpiovar.h Sat Jan 11 06:35:29 2014
(r260533)
@@ -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 */
_______________________________________________
svn-src-all@freebsd.org mailing list
http://lists.freebsd.org/mailman/listinfo/svn-src-all
To unsubscribe, send any mail to "svn-src-all-unsubscr...@freebsd.org"
