/*
* Copyright (c) 2009 Hypertriton, Inc.
* 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 COPYRIGHT HOLDERS AND CONTRIBUTORS "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 OR CONTRIBUTORS 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.
*/
/*
* Status LED for CNC operations.
*/
#include
#include
#include
#include
#include
#include
#include
#include
#include
#include
#include
#include
#include
#include
#include
#include
#include
int cncstatled_match(struct device *, void *, void *);
void cncstatled_attach(struct device *, struct device *, void *);
int cncstatled_detach(struct device *, int);
int cncstatled_activate(struct device *, enum devact);
void cncstatled_abort_all(void);
struct cfattach cncstatled_ca = {
sizeof(struct cncstatled_softc),
cncstatled_match,
cncstatled_attach,
cncstatled_detach,
cncstatled_activate
};
struct cfdriver cncstatled_cd = {
NULL, "cncstatled", DV_DULL
};
int
cncstatled_match(struct device *parent, void *match, void *aux)
{
struct cfdata *cf = match;
return (strcmp(cf->cf_driver->cd_name, "cncstatled") == 0);
}
void
cncstatled_attach(struct device *parent, struct device *self, void *aux)
{
struct cncstatled_softc *sc = (struct cncstatled_softc *)self;
struct gpio_attach_args *ga = aux;
cnc_status_led = sc;
if (gpio_npins(ga->ga_mask) != 1) {
printf(": invalid pin mask\n");
return;
}
sc->sc_gpio = ga->ga_gpio;
sc->sc_map.pm_map = sc->__map;
if (gpio_pin_map(sc->sc_gpio, ga->ga_offset, ga->ga_mask,
&sc->sc_map)) {
printf(": can't map pins\n");
return;
}
/* Map the output signal. */
CNC_MAP_OUTPUT(sc, 0, "LED");
printf("\n");
return;
fail:
gpio_pin_unmap(sc->sc_gpio, &sc->sc_map);
}
int
cncstatled_detach(struct device *self, int flags)
{
return (0);
}
int
cncstatled_activate(struct device *self, enum devact act)
{
return (0);
}
/* Set the state of the LED. */
void
cncstatled_set(int state)
{
struct cncstatled_softc *sc;
if ((sc = cnc_status_led) != NULL)
gpio_pin_write(sc->sc_gpio, &sc->sc_map, 0,
state ? GPIO_PIN_HIGH : GPIO_PIN_LOW);
}