avila_led.c revision 330897
1/*- 2 * SPDX-License-Identifier: BSD-2-Clause-FreeBSD 3 * 4 * Copyright (c) 2006 Kevin Lo. All rights reserved. 5 * 6 * Redistribution and use in source and binary forms, with or without 7 * modification, are permitted provided that the following conditions 8 * are met: 9 * 1. Redistributions of source code must retain the above copyright 10 * notice, this list of conditions and the following disclaimer. 11 * 2. Redistributions in binary form must reproduce the above copyright 12 * notice, this list of conditions and the following disclaimer in the 13 * documentation and/or other materials provided with the distribution. 14 * 15 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 16 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 17 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 18 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 19 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 20 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 21 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 22 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 23 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 24 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 25 */ 26 27#include <sys/cdefs.h> 28__FBSDID("$FreeBSD: stable/11/sys/arm/xscale/ixp425/avila_led.c 330897 2018-03-14 03:19:51Z eadler $"); 29 30#include <sys/param.h> 31#include <sys/systm.h> 32#include <sys/kernel.h> 33#include <sys/module.h> 34#include <sys/bus.h> 35 36#include <arm/xscale/ixp425/ixp425reg.h> 37#include <arm/xscale/ixp425/ixp425var.h> 38 39#include <dev/led/led.h> 40 41#define GPIO_LED_STATUS 3 42#define GPIO_LED_STATUS_BIT (1U << GPIO_LED_STATUS) 43 44struct led_avila_softc { 45 device_t sc_dev; 46 bus_space_tag_t sc_iot; 47 bus_space_handle_t sc_gpio_ioh; 48 struct cdev *sc_led; 49}; 50 51static void 52led_func(void *arg, int onoff) 53{ 54 struct led_avila_softc *sc = arg; 55 uint32_t reg; 56 57 IXP4XX_GPIO_LOCK(); 58 reg = GPIO_CONF_READ_4(sc, IXP425_GPIO_GPOUTR); 59 if (onoff) 60 reg &= ~GPIO_LED_STATUS_BIT; 61 else 62 reg |= GPIO_LED_STATUS_BIT; 63 GPIO_CONF_WRITE_4(sc, IXP425_GPIO_GPOUTR, reg); 64 IXP4XX_GPIO_UNLOCK(); 65} 66 67static int 68led_avila_probe(device_t dev) 69{ 70 device_set_desc(dev, "Gateworks Avila Front Panel LED"); 71 return (0); 72} 73 74static int 75led_avila_attach(device_t dev) 76{ 77 struct led_avila_softc *sc = device_get_softc(dev); 78 struct ixp425_softc *sa = device_get_softc(device_get_parent(dev)); 79 80 sc->sc_dev = dev; 81 sc->sc_iot = sa->sc_iot; 82 sc->sc_gpio_ioh = sa->sc_gpio_ioh; 83 84 /* Configure LED GPIO pin as output */ 85 GPIO_CONF_WRITE_4(sc, IXP425_GPIO_GPOER, 86 GPIO_CONF_READ_4(sc, IXP425_GPIO_GPOER) &~ GPIO_LED_STATUS_BIT); 87 88 sc->sc_led = led_create(led_func, sc, "gpioled"); 89 90 led_func(sc, 1); /* Turn on LED */ 91 92 return (0); 93} 94 95static int 96led_avila_detach(device_t dev) 97{ 98 struct led_avila_softc *sc = device_get_softc(dev); 99 100 if (sc->sc_led != NULL) 101 led_destroy(sc->sc_led); 102 return (0); 103} 104 105static device_method_t led_avila_methods[] = { 106 DEVMETHOD(device_probe, led_avila_probe), 107 DEVMETHOD(device_attach, led_avila_attach), 108 DEVMETHOD(device_detach, led_avila_detach), 109 110 {0, 0}, 111}; 112 113static driver_t led_avila_driver = { 114 "led_avila", 115 led_avila_methods, 116 sizeof(struct led_avila_softc), 117}; 118static devclass_t led_avila_devclass; 119 120DRIVER_MODULE(led_avila, ixp, led_avila_driver, led_avila_devclass, 0, 0); 121