194 lines
5.3 KiB
C
194 lines
5.3 KiB
C
/* $NetBSD: n900_kbdsld.c,v 1.2 2013/06/03 01:47:58 khorben Exp $ */
|
|
|
|
/*
|
|
* Keypad slide driver for the Nokia N900.
|
|
*
|
|
* Copyright (c) 2013 The NetBSD Foundation, Inc.
|
|
* All rights reserved.
|
|
*
|
|
* This code is derived from software contributed to The NetBSD Foundation
|
|
* by Pierre Pronchery (khorben@defora.org).
|
|
*
|
|
* 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 NETBSD FOUNDATION, INC. 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 FOUNDATION 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.
|
|
*/
|
|
|
|
#include <sys/cdefs.h>
|
|
__KERNEL_RCSID(0, "$NetBSD: n900_kbdsld.c,v 1.2 2013/06/03 01:47:58 khorben Exp $");
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/device.h>
|
|
#include <sys/gpio.h>
|
|
|
|
#include <dev/gpio/gpiovar.h>
|
|
#include <dev/sysmon/sysmonvar.h>
|
|
#include <dev/sysmon/sysmon_taskq.h>
|
|
|
|
#include <arm/omap/omap2_gpio.h>
|
|
|
|
|
|
/* The base interrupt for the corresponding GPIO device where this driver
|
|
* attaches. This is an ugly workaround the current limitations of gpio(4),
|
|
* which does not seem to allow a better way to locate the interrupt yet. */
|
|
#define N900KBDSLD_GPIO_BASE 160
|
|
|
|
#define N900KBDSLD_PIN_INPUT 0
|
|
#define N900KBDSLD_NPINS 1
|
|
|
|
|
|
struct n900kbdsld_softc
|
|
{
|
|
device_t sc_dev;
|
|
void * sc_gpio;
|
|
void * sc_intr;
|
|
|
|
struct gpio_pinmap sc_map;
|
|
int sc_map_pins[N900KBDSLD_NPINS];
|
|
|
|
struct sysmon_pswitch sc_smpsw;
|
|
};
|
|
|
|
static int n900kbdsld_match(device_t, cfdata_t, void *);
|
|
static void n900kbdsld_attach(device_t, device_t, void *);
|
|
static int n900kbdsld_detach(device_t, int);
|
|
|
|
CFATTACH_DECL_NEW(n900kbdsld, sizeof(struct n900kbdsld_softc),
|
|
n900kbdsld_match, n900kbdsld_attach, n900kbdsld_detach, NULL);
|
|
|
|
static void n900kbdsld_refresh(void *);
|
|
|
|
static int n900kbdsld_intr(void *);
|
|
|
|
|
|
static int
|
|
n900kbdsld_match(device_t parent, cfdata_t cf, void * aux)
|
|
{
|
|
struct gpio_attach_args *ga = aux;
|
|
|
|
if (strcmp(ga->ga_dvname, cf->cf_name))
|
|
return 0;
|
|
|
|
if (ga->ga_offset == -1)
|
|
return 0;
|
|
|
|
/* check that we have enough pins */
|
|
if (gpio_npins(ga->ga_mask) != N900KBDSLD_NPINS) {
|
|
aprint_debug("%s: invalid pin mask 0x%02x\n", cf->cf_name,
|
|
ga->ga_mask);
|
|
return 0;
|
|
}
|
|
|
|
return 1;
|
|
}
|
|
|
|
static void
|
|
n900kbdsld_attach(device_t parent, device_t self, void *aux)
|
|
{
|
|
struct n900kbdsld_softc *sc = device_private(self);
|
|
struct gpio_attach_args *ga = aux;
|
|
int caps;
|
|
|
|
sc->sc_dev = self;
|
|
sc->sc_gpio = ga->ga_gpio;
|
|
|
|
/* map pins */
|
|
sc->sc_map.pm_map = sc->sc_map_pins;
|
|
if (gpio_pin_map(sc->sc_gpio, ga->ga_offset, ga->ga_mask,
|
|
&sc->sc_map)) {
|
|
aprint_error(": couldn't map the pins\n");
|
|
return;
|
|
}
|
|
|
|
/* configure the input pin */
|
|
caps = gpio_pin_caps(sc->sc_gpio, &sc->sc_map, N900KBDSLD_PIN_INPUT);
|
|
if (!(caps & GPIO_PIN_INPUT)) {
|
|
aprint_error(": pin is unable to read input\n");
|
|
gpio_pin_unmap(sc->sc_gpio, &sc->sc_map);
|
|
return;
|
|
}
|
|
gpio_pin_ctl(sc->sc_gpio, &sc->sc_map, N900KBDSLD_PIN_INPUT,
|
|
GPIO_PIN_INPUT);
|
|
|
|
sc->sc_intr = intr_establish(N900KBDSLD_GPIO_BASE + ga->ga_offset,
|
|
IPL_VM, IST_EDGE_BOTH, n900kbdsld_intr, sc);
|
|
if (sc->sc_intr == NULL) {
|
|
aprint_error(": couldn't establish interrupt\n");
|
|
gpio_pin_unmap(sc->sc_gpio, &sc->sc_map);
|
|
return;
|
|
}
|
|
|
|
aprint_normal(": N900 keypad slide\n");
|
|
aprint_naive(": N900 keypad slide\n");
|
|
|
|
if (!pmf_device_register(sc->sc_dev, NULL, NULL)) {
|
|
aprint_error_dev(sc->sc_dev,
|
|
"couldn't establish power handler\n");
|
|
}
|
|
|
|
sysmon_task_queue_init();
|
|
sc->sc_smpsw.smpsw_name = device_xname(self);
|
|
sc->sc_smpsw.smpsw_type = PSWITCH_TYPE_HOTKEY;
|
|
sysmon_pswitch_register(&sc->sc_smpsw);
|
|
|
|
n900kbdsld_refresh(sc);
|
|
}
|
|
|
|
static int
|
|
n900kbdsld_detach(device_t self, int flags)
|
|
{
|
|
struct n900kbdsld_softc *sc = device_private(self);
|
|
|
|
if (sc->sc_intr != NULL) {
|
|
intr_disestablish(sc->sc_intr);
|
|
}
|
|
|
|
gpio_pin_unmap(sc->sc_gpio, &sc->sc_map);
|
|
pmf_device_deregister(self);
|
|
sysmon_task_queue_fini();
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int
|
|
n900kbdsld_intr(void *v)
|
|
{
|
|
struct n900kbdsld_softc *sc = v;
|
|
|
|
sysmon_task_queue_sched(0, n900kbdsld_refresh, sc);
|
|
return 1;
|
|
}
|
|
|
|
static void
|
|
n900kbdsld_refresh(void *v)
|
|
{
|
|
struct n900kbdsld_softc *sc = v;
|
|
int i;
|
|
int event;
|
|
|
|
i = gpio_pin_read(sc->sc_gpio, &sc->sc_map, N900KBDSLD_PIN_INPUT);
|
|
event = (i == GPIO_PIN_HIGH)
|
|
? PSWITCH_EVENT_PRESSED : PSWITCH_EVENT_RELEASED;
|
|
|
|
/* report the event */
|
|
sysmon_pswitch_event(&sc->sc_smpsw, event);
|
|
}
|