Bring in status led support for /dev/led/gpioled on Avila.

Approved by: cognet

4 files changed, 118 insertions, 0 deletions

diff --git a/sys/arm/conf/AVILA b/sys/arm/conf/AVILA
index 3f2c1c8..fcc5380 100644
--- a/sys/arm/conf/AVILA
+++ b/sys/arm/conf/AVILA
@@ -95,6 +95,8 @@ device		ixpwdog		# watchdog timer
 device		ds1672		# DS1672 on I2C bus
 device		ad7418		# AD7418 on I2C bus
 
+device		avila_led
+
 device		ata
 device		atadisk         # ATA disk drives
 device		avila_ata	# Gateworks CF/IDE support
diff --git a/sys/arm/xscale/ixp425/avila_led.c b/sys/arm/xscale/ixp425/avila_led.c
new file mode 100644
index 0000000..2493076
--- /dev/null
+++ b/sys/arm/xscale/ixp425/avila_led.c
@@ -0,0 +1,114 @@
+/*-
+ * Copyright (c) 2006 Kevin Lo.  All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ * 1. Redistributions of source code must retain the above copyright
+ *    notice, this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must reproduce the above copyright
+ *    notice, this list of conditions and the following disclaimer in the
+ *    documentation and/or other materials provided with the distribution.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
+ * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
+ * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
+ * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
+ * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
+ * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
+ * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
+ * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ */
+
+#include <sys/cdefs.h>
+__FBSDID("$FreeBSD$");
+
+#include <sys/param.h>
+#include <sys/systm.h>
+#include <sys/kernel.h>
+#include <sys/module.h>
+#include <sys/bus.h>
+
+#include <arm/xscale/ixp425/ixp425reg.h>
+#include <arm/xscale/ixp425/ixp425var.h>
+
+#include <dev/led/led.h>
+
+#define	GPIO_LED_STATUS	3
+#define	  GPIO_LED_STATUS_BIT	(1U << GPIO_LED_STATUS)
+
+static struct cdev *gpioled;
+
+struct led_avila_softc {
+	device_t		sc_dev;
+	bus_space_tag_t		sc_iot;
+	bus_space_handle_t	sc_gpio_ioh;
+};
+
+static struct led_avila_softc *led_avila_sc = NULL;
+
+static void
+led_func(void *unused, int onoff)
+{
+	struct led_avila_softc *sc = led_avila_sc;
+	uint32_t reg;
+
+	reg = GPIO_CONF_READ_4(sc, IXP425_GPIO_GPOUTR);
+	if (onoff)
+		reg &= ~GPIO_LED_STATUS_BIT;
+	else
+		reg |= GPIO_LED_STATUS_BIT;
+	GPIO_CONF_WRITE_4(sc, IXP425_GPIO_GPOUTR, reg);
+}
+
+static int
+led_avila_probe(device_t dev)
+{
+	device_set_desc(dev, "Gateworks Avila GPIO connected LED");
+	return (0);
+}
+
+static int
+led_avila_attach(device_t dev)
+{
+	struct led_avila_softc *sc = device_get_softc(dev);
+	struct ixp425_softc *sa = device_get_softc(device_get_parent(dev));
+	void *led = NULL;
+	uint32_t reg;
+
+	led_avila_sc = sc;
+
+	sc->sc_dev = dev;
+	sc->sc_iot = sa->sc_iot;
+	sc->sc_gpio_ioh = sa->sc_gpio_ioh;
+
+	/* Configure LED GPIO pin as output */
+	reg = GPIO_CONF_READ_4(sc, IXP425_GPIO_GPOER);
+	reg &= ~GPIO_LED_STATUS_BIT;
+	GPIO_CONF_WRITE_4(sc, IXP425_GPIO_GPOER, reg);
+
+	gpioled = led_create(led_func, led, "gpioled");
+
+	/* Turn on LED */
+	led_func(led, 1);
+
+	return (0);
+}
+
+static device_method_t led_avila_methods[] = {
+	DEVMETHOD(device_probe,		led_avila_probe),
+	DEVMETHOD(device_attach,	led_avila_attach),
+
+	{0, 0},
+};
+
+static driver_t led_avila_driver = {
+	"led_avila",
+	led_avila_methods,
+	sizeof(struct led_avila_softc),
+};
+static devclass_t led_avila_devclass;
+
+DRIVER_MODULE(led_avila, ixp, led_avila_driver, led_avila_devclass, 0, 0);
diff --git a/sys/arm/xscale/ixp425/files.avila b/sys/arm/xscale/ixp425/files.avila
index f5f2dbc..50910ce 100644
--- a/sys/arm/xscale/ixp425/files.avila
+++ b/sys/arm/xscale/ixp425/files.avila
@@ -1,4 +1,5 @@
 #$FreeBSD$
 arm/xscale/ixp425/avila_machdep.c	standard
 arm/xscale/ixp425/avila_ata.c		optional avila_ata
+arm/xscale/ixp425/avila_led.c		optional avila_led
 arm/xscale/ixp425/ixdp425_pci.c		optional pci
diff --git a/sys/arm/xscale/ixp425/ixp425.c b/sys/arm/xscale/ixp425/ixp425.c
index 48ac29c..fbbc707 100644
--- a/sys/arm/xscale/ixp425/ixp425.c
+++ b/sys/arm/xscale/ixp425/ixp425.c
@@ -233,6 +233,7 @@ ixp425_attach(device_t dev)
 	device_add_child(dev, "npe", 0);	/* NPE-B */
 	device_add_child(dev, "npe", 1);	/* NPE-C */
 	device_add_child(dev, "ata_avila", 0);	/* XXX */
+	device_add_child(dev, "led_avila", 0);
 
 	if (bus_space_map(sc->sc_iot, IXP425_GPIO_HWBASE, IXP425_GPIO_SIZE,
 	    0, &sc->sc_gpio_ioh))