Use GPIO pin management API in gpiobacklight
- Get rid of hack with re-parenting gpio-leds node to gpiobus - Use gpio_pin_set_active to enable/disable backlight, it automatically takes care of active-low pins
This commit is contained in:
parent
0c3833fbcb
commit
26c36284a9
@ -1,5 +1,5 @@
|
|||||||
/*-
|
/*-
|
||||||
* Copyright (c) 2015 Oleksandr Tymoshenko <gonzo@freebsd.org>
|
* Copyright (c) 2015-2016 Oleksandr Tymoshenko <gonzo@freebsd.org>
|
||||||
* All rights reserved.
|
* All rights reserved.
|
||||||
*
|
*
|
||||||
* Redistribution and use in source and binary forms, with or without
|
* Redistribution and use in source and binary forms, with or without
|
||||||
@ -45,28 +45,11 @@ __FBSDID("$FreeBSD$");
|
|||||||
|
|
||||||
#include <dev/gpio/gpiobusvar.h>
|
#include <dev/gpio/gpiobusvar.h>
|
||||||
|
|
||||||
#include "gpiobus_if.h"
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Only one pin for led
|
|
||||||
*/
|
|
||||||
#define GPIOBL_PIN 0
|
|
||||||
|
|
||||||
#define GPIOBL_LOCK(_sc) mtx_lock(&(_sc)->sc_mtx)
|
|
||||||
#define GPIOBL_UNLOCK(_sc) mtx_unlock(&(_sc)->sc_mtx)
|
|
||||||
#define GPIOBL_LOCK_INIT(_sc) \
|
|
||||||
mtx_init(&_sc->sc_mtx, device_get_nameunit(_sc->sc_dev), \
|
|
||||||
"gpiobacklight", MTX_DEF)
|
|
||||||
#define GPIOBL_LOCK_DESTROY(_sc) mtx_destroy(&_sc->sc_mtx);
|
|
||||||
|
|
||||||
struct gpiobacklight_softc
|
struct gpiobacklight_softc
|
||||||
{
|
{
|
||||||
device_t sc_dev;
|
gpio_pin_t sc_pin;
|
||||||
device_t sc_busdev;
|
|
||||||
struct mtx sc_mtx;
|
|
||||||
|
|
||||||
struct sysctl_oid *sc_oid;
|
struct sysctl_oid *sc_oid;
|
||||||
int sc_brightness;
|
bool sc_brightness;
|
||||||
};
|
};
|
||||||
|
|
||||||
static int gpiobacklight_sysctl(SYSCTL_HANDLER_ARGS);
|
static int gpiobacklight_sysctl(SYSCTL_HANDLER_ARGS);
|
||||||
@ -78,22 +61,9 @@ static int gpiobacklight_detach(device_t);
|
|||||||
static void
|
static void
|
||||||
gpiobacklight_update_brightness(struct gpiobacklight_softc *sc)
|
gpiobacklight_update_brightness(struct gpiobacklight_softc *sc)
|
||||||
{
|
{
|
||||||
int error;
|
|
||||||
|
|
||||||
GPIOBL_LOCK(sc);
|
if (sc->sc_pin)
|
||||||
error = GPIOBUS_ACQUIRE_BUS(sc->sc_busdev, sc->sc_dev,
|
gpio_pin_set_active(sc->sc_pin, sc->sc_brightness);
|
||||||
GPIOBUS_DONTWAIT);
|
|
||||||
if (error != 0) {
|
|
||||||
GPIOBL_UNLOCK(sc);
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
error = GPIOBUS_PIN_SETFLAGS(sc->sc_busdev, sc->sc_dev,
|
|
||||||
GPIOBL_PIN, GPIO_PIN_OUTPUT);
|
|
||||||
if (error == 0)
|
|
||||||
GPIOBUS_PIN_SET(sc->sc_busdev, sc->sc_dev, GPIOBL_PIN,
|
|
||||||
sc->sc_brightness ? GPIO_PIN_HIGH : GPIO_PIN_LOW);
|
|
||||||
GPIOBUS_RELEASE_BUS(sc->sc_busdev, sc->sc_dev);
|
|
||||||
GPIOBL_UNLOCK(sc);
|
|
||||||
}
|
}
|
||||||
|
|
||||||
static int
|
static int
|
||||||
@ -104,35 +74,17 @@ gpiobacklight_sysctl(SYSCTL_HANDLER_ARGS)
|
|||||||
int brightness;
|
int brightness;
|
||||||
|
|
||||||
sc = (struct gpiobacklight_softc*)arg1;
|
sc = (struct gpiobacklight_softc*)arg1;
|
||||||
|
|
||||||
brightness = sc->sc_brightness;
|
brightness = sc->sc_brightness;
|
||||||
error = sysctl_handle_int(oidp, &brightness, 0, req);
|
error = sysctl_handle_int(oidp, &brightness, 0, req);
|
||||||
|
|
||||||
if (error != 0 || req->newptr == NULL)
|
if (error != 0 || req->newptr == NULL)
|
||||||
return (error);
|
return (error);
|
||||||
|
|
||||||
if (brightness <= 0)
|
sc->sc_brightness = (brightness > 0);
|
||||||
sc->sc_brightness = 0;
|
|
||||||
else
|
|
||||||
sc->sc_brightness = 1;
|
|
||||||
|
|
||||||
gpiobacklight_update_brightness(sc);
|
gpiobacklight_update_brightness(sc);
|
||||||
|
|
||||||
return (error);
|
return (0);
|
||||||
}
|
|
||||||
|
|
||||||
static void
|
|
||||||
gpiobacklight_identify(driver_t *driver, device_t bus)
|
|
||||||
{
|
|
||||||
phandle_t node, root;
|
|
||||||
|
|
||||||
root = OF_finddevice("/");
|
|
||||||
if (root == 0)
|
|
||||||
return;
|
|
||||||
for (node = OF_child(root); node != 0; node = OF_peer(node)) {
|
|
||||||
if (!fdt_is_compatible_strict(node, "gpio-backlight"))
|
|
||||||
continue;
|
|
||||||
ofw_gpiobus_add_fdt_child(bus, driver->name, node);
|
|
||||||
}
|
|
||||||
}
|
}
|
||||||
|
|
||||||
static int
|
static int
|
||||||
@ -156,27 +108,32 @@ gpiobacklight_attach(device_t dev)
|
|||||||
phandle_t node;
|
phandle_t node;
|
||||||
|
|
||||||
sc = device_get_softc(dev);
|
sc = device_get_softc(dev);
|
||||||
sc->sc_dev = dev;
|
|
||||||
sc->sc_busdev = device_get_parent(dev);
|
|
||||||
|
|
||||||
if ((node = ofw_bus_get_node(dev)) == -1)
|
if ((node = ofw_bus_get_node(dev)) == -1)
|
||||||
return (ENXIO);
|
return (ENXIO);
|
||||||
|
|
||||||
GPIOBL_LOCK_INIT(sc);
|
|
||||||
if (OF_hasprop(node, "default-on"))
|
if (OF_hasprop(node, "default-on"))
|
||||||
sc->sc_brightness = 1;
|
sc->sc_brightness = true;
|
||||||
else
|
else
|
||||||
sc->sc_brightness = 0;
|
sc->sc_brightness = false;
|
||||||
|
|
||||||
|
gpio_pin_get_by_ofw_idx(dev, node, 0, &sc->sc_pin);
|
||||||
|
if (sc->sc_pin == NULL) {
|
||||||
|
device_printf(dev, "failed to map GPIO pin\n");
|
||||||
|
return (ENXIO);
|
||||||
|
}
|
||||||
|
|
||||||
|
gpio_pin_setflags(sc->sc_pin, GPIO_PIN_OUTPUT);
|
||||||
|
|
||||||
|
gpiobacklight_update_brightness(sc);
|
||||||
|
|
||||||
/* Init backlight interface */
|
/* Init backlight interface */
|
||||||
ctx = device_get_sysctl_ctx(sc->sc_dev);
|
ctx = device_get_sysctl_ctx(dev);
|
||||||
tree = device_get_sysctl_tree(sc->sc_dev);
|
tree = device_get_sysctl_tree(dev);
|
||||||
sc->sc_oid = SYSCTL_ADD_PROC(ctx, SYSCTL_CHILDREN(tree), OID_AUTO,
|
sc->sc_oid = SYSCTL_ADD_PROC(ctx, SYSCTL_CHILDREN(tree), OID_AUTO,
|
||||||
"brightness", CTLTYPE_INT | CTLFLAG_RW, sc, 0,
|
"brightness", CTLTYPE_INT | CTLFLAG_RW, sc, 0,
|
||||||
gpiobacklight_sysctl, "I", "backlight brightness");
|
gpiobacklight_sysctl, "I", "backlight brightness");
|
||||||
|
|
||||||
gpiobacklight_update_brightness(sc);
|
|
||||||
|
|
||||||
return (0);
|
return (0);
|
||||||
}
|
}
|
||||||
|
|
||||||
@ -186,7 +143,10 @@ gpiobacklight_detach(device_t dev)
|
|||||||
struct gpiobacklight_softc *sc;
|
struct gpiobacklight_softc *sc;
|
||||||
|
|
||||||
sc = device_get_softc(dev);
|
sc = device_get_softc(dev);
|
||||||
GPIOBL_LOCK_DESTROY(sc);
|
|
||||||
|
if (sc->sc_pin)
|
||||||
|
gpio_pin_release(sc->sc_pin);
|
||||||
|
|
||||||
return (0);
|
return (0);
|
||||||
}
|
}
|
||||||
|
|
||||||
@ -194,7 +154,6 @@ static devclass_t gpiobacklight_devclass;
|
|||||||
|
|
||||||
static device_method_t gpiobacklight_methods[] = {
|
static device_method_t gpiobacklight_methods[] = {
|
||||||
/* Device interface */
|
/* Device interface */
|
||||||
DEVMETHOD(device_identify, gpiobacklight_identify),
|
|
||||||
DEVMETHOD(device_probe, gpiobacklight_probe),
|
DEVMETHOD(device_probe, gpiobacklight_probe),
|
||||||
DEVMETHOD(device_attach, gpiobacklight_attach),
|
DEVMETHOD(device_attach, gpiobacklight_attach),
|
||||||
DEVMETHOD(device_detach, gpiobacklight_detach),
|
DEVMETHOD(device_detach, gpiobacklight_detach),
|
||||||
@ -208,4 +167,6 @@ static driver_t gpiobacklight_driver = {
|
|||||||
sizeof(struct gpiobacklight_softc),
|
sizeof(struct gpiobacklight_softc),
|
||||||
};
|
};
|
||||||
|
|
||||||
DRIVER_MODULE(gpiobacklight, gpiobus, gpiobacklight_driver, gpiobacklight_devclass, 0, 0);
|
DRIVER_MODULE(gpiobacklight, simplebus, gpiobacklight_driver,
|
||||||
|
gpiobacklight_devclass, 0, 0);
|
||||||
|
MODULE_DEPEND(gpiobacklight, gpiobus, 1, 1, 1);
|
||||||
|
Loading…
x
Reference in New Issue
Block a user