Source-Changes-HG archive
[Date Prev][Date Next][Thread Prev][Thread Next][Date Index][Thread Index][Old Index]
[src/trunk]: src/sys/dev/i2c add support for detaching iic(4)
details: https://anonhg.NetBSD.org/src/rev/6d94a98327d5
branches: trunk
changeset: 770070:6d94a98327d5
user: jmcneill <jmcneill%NetBSD.org@localhost>
date: Sun Oct 02 18:58:45 2011 +0000
description:
add support for detaching iic(4)
diffstat:
sys/dev/i2c/i2c.c | 77 ++++++++++++++++++++++++++++++++++++++++++++++--------
1 files changed, 65 insertions(+), 12 deletions(-)
diffs (133 lines):
diff -r 6e6c55ee8910 -r 6d94a98327d5 sys/dev/i2c/i2c.c
--- a/sys/dev/i2c/i2c.c Sun Oct 02 18:34:17 2011 +0000
+++ b/sys/dev/i2c/i2c.c Sun Oct 02 18:58:45 2011 +0000
@@ -1,4 +1,4 @@
-/* $NetBSD: i2c.c,v 1.32 2011/10/02 17:39:40 jmcneill Exp $ */
+/* $NetBSD: i2c.c,v 1.33 2011/10/02 18:58:45 jmcneill Exp $ */
/*
* Copyright (c) 2003 Wasabi Systems, Inc.
@@ -36,7 +36,7 @@
*/
#include <sys/cdefs.h>
-__KERNEL_RCSID(0, "$NetBSD: i2c.c,v 1.32 2011/10/02 17:39:40 jmcneill Exp $");
+__KERNEL_RCSID(0, "$NetBSD: i2c.c,v 1.33 2011/10/02 18:58:45 jmcneill Exp $");
#include <sys/param.h>
#include <sys/systm.h>
@@ -128,10 +128,9 @@
ia.ia_compat = NULL;
if (config_match(parent, cf, &ia) > 0) {
- if (ia.ia_addr == (i2c_addr_t)-1)
- config_attach(parent, cf, &ia, iic_print);
- else if (ia.ia_addr <= I2C_MAX_ADDR &&
- !sc->sc_devices[ia.ia_addr])
+ if (ia.ia_addr != (i2c_addr_t)-1 &&
+ ia.ia_addr <= I2C_MAX_ADDR &&
+ !sc->sc_devices[ia.ia_addr])
sc->sc_devices[ia.ia_addr] =
config_attach(parent, cf, &ia, iic_print);
}
@@ -175,7 +174,7 @@
i2c_tag_t ic;
int rv;
- aprint_naive(": I2C bus\n");
+ aprint_naive("\n");
aprint_normal(": I2C bus\n");
sc->sc_tag = iba->iba_tag;
@@ -186,8 +185,9 @@
LIST_INIT(&(sc->sc_tag->ic_list));
LIST_INIT(&(sc->sc_tag->ic_proc_list));
- rv = kthread_create(PRI_NONE, 0, NULL, iic_smbus_intr_thread,
- ic, &ic->ic_intr_thread, "%s", ic->ic_devname);
+ rv = kthread_create(PRI_NONE, KTHREAD_MUSTJOIN, NULL,
+ iic_smbus_intr_thread, ic, &ic->ic_intr_thread,
+ "%s", ic->ic_devname);
if (rv)
aprint_error_dev(self, "unable to create intr thread\n");
@@ -238,8 +238,19 @@
prop_data_data_nocopy(cdata),
prop_data_size(cdata), &buf);
- config_found_sm_loc(self, "iic", loc, &ia,
- iic_print_direct, NULL);
+ if (addr > I2C_MAX_ADDR) {
+ aprint_error_dev(self,
+ "WARNING: ignoring bad device address "
+ "@ 0x%02x\n", addr);
+ } else if (ia.ia_addr == addr) {
+ aprint_error_dev(self,
+ "WARNING: ignoring duplicate device "
+ "@ 0x%02x\n", addr);
+ } else if (sc->sc_devices[addr] == NULL) {
+ sc->sc_devices[addr] =
+ config_found_sm_loc(self, "iic", loc, &ia,
+ iic_print_direct, NULL);
+ }
if (ia.ia_compat)
free(ia.ia_compat, M_TEMP);
@@ -255,6 +266,48 @@
}
}
+static int
+iic_detach(device_t self, int flags)
+{
+ struct iic_softc *sc = device_private(self);
+ i2c_tag_t ic = sc->sc_tag;
+ int i, error;
+ void *hdl;
+
+ for (i = 0; i <= I2C_MAX_ADDR; i++) {
+ if (sc->sc_devices[i]) {
+ error = config_detach(sc->sc_devices[i], flags);
+ if (error)
+ return error;
+ }
+ }
+
+ if (ic->ic_running) {
+ ic->ic_running = 0;
+ wakeup(ic);
+ kthread_join(ic->ic_intr_thread);
+ }
+
+ if (!LIST_EMPTY(&ic->ic_list)) {
+ device_printf(self, "WARNING: intr handler list not empty\n");
+ while (!LIST_EMPTY(&ic->ic_list)) {
+ hdl = LIST_FIRST(&ic->ic_list);
+ iic_smbus_intr_disestablish(ic, hdl);
+ }
+ }
+ if (!LIST_EMPTY(&ic->ic_proc_list)) {
+ device_printf(self, "WARNING: proc handler list not empty\n");
+ while (!LIST_EMPTY(&ic->ic_proc_list)) {
+ hdl = LIST_FIRST(&ic->ic_proc_list);
+ iic_smbus_intr_disestablish_proc(ic, hdl);
+ }
+ }
+
+ pmf_device_deregister(self);
+
+ return 0;
+}
+
static void
iic_smbus_intr_thread(void *aux)
{
@@ -486,7 +539,7 @@
CFATTACH_DECL2_NEW(iic, sizeof(struct iic_softc),
- iic_match, iic_attach, NULL, NULL, iic_rescan, iic_child_detach);
+ iic_match, iic_attach, iic_detach, NULL, iic_rescan, iic_child_detach);
MODULE(MODULE_CLASS_DRIVER, iic, NULL);
Home |
Main Index |
Thread Index |
Old Index