Module Name: src
Committed By: jmcneill
Date: Fri May 29 23:17:13 UTC 2015
Modified Files:
src/sys/dev/gpio: files.gpio
Added Files:
src/sys/dev/gpio: gpiorfkill.c
Log Message:
Simple driver for gpio control of rf enable/disable pins.
To generate a diff of this commit:
cvs rdiff -u -r1.10 -r1.11 src/sys/dev/gpio/files.gpio
cvs rdiff -u -r0 -r1.1 src/sys/dev/gpio/gpiorfkill.c
Please note that diffs are not public domain; they are subject to the
copyright notices on the relevant files.
Modified files:
Index: src/sys/dev/gpio/files.gpio
diff -u src/sys/dev/gpio/files.gpio:1.10 src/sys/dev/gpio/files.gpio:1.11
--- src/sys/dev/gpio/files.gpio:1.10 Sun Nov 13 12:33:00 2011
+++ src/sys/dev/gpio/files.gpio Fri May 29 23:17:13 2015
@@ -1,4 +1,4 @@
-# $NetBSD: files.gpio,v 1.10 2011/11/13 12:33:00 mbalmer Exp $
+# $NetBSD: files.gpio,v 1.11 2015/05/29 23:17:13 jmcneill Exp $
define gpio {[offset = -1], [mask = 0], [flag = 0]}
@@ -29,3 +29,8 @@ file dev/gpio/gpiolock.c gpiolock
device gpiopwm: gpiobus
attach gpiopwm at gpio
file dev/gpio/gpiopwm.c gpiopwm
+
+# RF kill
+device gpiorfkill: gpiobus
+attach gpiorfkill at gpio
+file dev/gpio/gpiorfkill.c gpiorfkill
Added files:
Index: src/sys/dev/gpio/gpiorfkill.c
diff -u /dev/null src/sys/dev/gpio/gpiorfkill.c:1.1
--- /dev/null Fri May 29 23:17:13 2015
+++ src/sys/dev/gpio/gpiorfkill.c Fri May 29 23:17:13 2015
@@ -0,0 +1,166 @@
+/* $NetBSD: gpiorfkill.c,v 1.1 2015/05/29 23:17:13 jmcneill Exp $ */
+
+/*-
+ * Copyright (c) 2015 Jared D. McNeill <[email protected]>
+ * 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 "locators.h"
+
+#include <sys/cdefs.h>
+__KERNEL_RCSID(0, "$NetBSD: gpiorfkill.c,v 1.1 2015/05/29 23:17:13 jmcneill Exp $");
+
+#include <sys/param.h>
+#include <sys/bus.h>
+#include <sys/device.h>
+#include <sys/intr.h>
+#include <sys/systm.h>
+#include <sys/kernel.h>
+#include <sys/sysctl.h>
+#include <sys/gpio.h>
+
+#include <dev/gpio/gpiovar.h>
+
+static int gpiorfkill_match(device_t, cfdata_t, void *);
+static void gpiorfkill_attach(device_t, device_t, void *);
+
+struct gpiorfkill_softc {
+ device_t sc_dev;
+ void *sc_gpio;
+ struct gpio_pinmap sc_map;
+ int sc_pinmap[1];
+
+ int sc_state;
+
+ struct sysctllog *sc_sysctllog;
+ int sc_sysctlnode;
+};
+
+static void gpiorfkill_enable(struct gpiorfkill_softc *, int);
+static void gpiorfkill_sysctl_init(struct gpiorfkill_softc *);
+static int gpiorfkill_enable_helper(SYSCTLFN_PROTO);
+
+CFATTACH_DECL_NEW(gpiorfkill, sizeof(struct gpiorfkill_softc),
+ gpiorfkill_match, gpiorfkill_attach, NULL, NULL);
+
+static int
+gpiorfkill_match(device_t parent, cfdata_t cf, void *aux)
+{
+ struct gpio_attach_args * const ga = aux;
+
+ if (strcmp(ga->ga_dvname, cf->cf_name) != 0)
+ return 0;
+
+ if (ga->ga_offset == -1 || gpio_npins(ga->ga_mask) != 1)
+ return 0;
+
+ return 1;
+}
+
+static void
+gpiorfkill_attach(device_t parent, device_t self, void *aux)
+{
+ struct gpiorfkill_softc * const sc = device_private(self);
+ struct gpio_attach_args * const ga = aux;
+ int caps;
+
+ sc->sc_dev = self;
+ sc->sc_gpio = ga->ga_gpio;
+ sc->sc_map.pm_map = sc->sc_pinmap;
+ if (gpio_pin_map(sc->sc_gpio, ga->ga_offset, ga->ga_mask,
+ &sc->sc_map)) {
+ aprint_error(": couldn't map pins\n");
+ return;
+ }
+
+ caps = gpio_pin_caps(sc->sc_gpio, &sc->sc_map, 0);
+ if ((caps & GPIO_PIN_OUTPUT) == 0) {
+ aprint_error(": pin is not an output pin\n");
+ return;
+ }
+
+ gpio_pin_ctl(sc->sc_gpio, &sc->sc_map, 0, GPIO_PIN_OUTPUT);
+
+ aprint_naive("\n");
+ aprint_normal("\n");
+
+ gpiorfkill_enable(sc, 1);
+ gpiorfkill_sysctl_init(sc);
+}
+
+static void
+gpiorfkill_enable(struct gpiorfkill_softc *sc, int enable)
+{
+ sc->sc_state = enable;
+ gpio_pin_write(sc->sc_gpio, &sc->sc_map, 0, sc->sc_state);
+}
+
+static void
+gpiorfkill_sysctl_init(struct gpiorfkill_softc *sc)
+{
+ const struct sysctlnode *node, *devnode;
+ int error;
+
+ error = sysctl_createv(&sc->sc_sysctllog, 0, NULL, &devnode,
+ 0, CTLTYPE_NODE, device_xname(sc->sc_dev), NULL,
+ NULL, 0, NULL, 0, CTL_HW, CTL_CREATE, CTL_EOL);
+ if (error)
+ goto sysctl_failed;
+
+ error = sysctl_createv(&sc->sc_sysctllog, 0, &devnode, &node,
+ CTLFLAG_READWRITE, CTLTYPE_INT, "enable", NULL,
+ gpiorfkill_enable_helper, 0, (void *)sc, 0,
+ CTL_CREATE, CTL_EOL);
+ if (error)
+ goto sysctl_failed;
+ sc->sc_sysctlnode = node->sysctl_num;
+
+ return;
+
+sysctl_failed:
+ aprint_error_dev(sc->sc_dev, "couldn't create sysctl nodes (%d)\n",
+ error);
+ sysctl_teardown(&sc->sc_sysctllog);
+}
+
+static int
+gpiorfkill_enable_helper(SYSCTLFN_ARGS)
+{
+ struct gpiorfkill_softc *sc;
+ struct sysctlnode node;
+ int error, enable;
+
+ node = *rnode;
+ sc = node.sysctl_data;
+ enable = sc->sc_state;
+ node.sysctl_data = &enable;
+ error = sysctl_lookup(SYSCTLFN_CALL(&node));
+ if (error || newp == NULL)
+ return error;
+
+ enable = !!enable;
+ gpiorfkill_enable(sc, enable);
+
+ return 0;
+}
