Home | History | Annotate | Line # | Download | only in adb
      1  1.14  macallan /*	$NetBSD: adb_bus.c,v 1.14 2025/06/16 07:51:16 macallan Exp $ */
      2   1.1  macallan 
      3   1.1  macallan /*-
      4   1.1  macallan  * Copyright (c) 2006 Michael Lorenz
      5   1.1  macallan  * All rights reserved.
      6   1.1  macallan  *
      7   1.1  macallan  * Redistribution and use in source and binary forms, with or without
      8   1.1  macallan  * modification, are permitted provided that the following conditions
      9   1.1  macallan  * are met:
     10   1.1  macallan  * 1. Redistributions of source code must retain the above copyright
     11   1.1  macallan  *    notice, this list of conditions and the following disclaimer.
     12   1.1  macallan  * 2. Redistributions in binary form must reproduce the above copyright
     13   1.1  macallan  *    notice, this list of conditions and the following disclaimer in the
     14   1.1  macallan  *    documentation and/or other materials provided with the distribution.
     15   1.1  macallan  *
     16   1.1  macallan  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     17   1.1  macallan  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     18   1.1  macallan  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     19   1.1  macallan  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     20   1.1  macallan  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     21   1.1  macallan  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     22   1.1  macallan  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     23   1.1  macallan  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     24   1.1  macallan  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     25   1.1  macallan  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     26   1.1  macallan  * POSSIBILITY OF SUCH DAMAGE.
     27   1.1  macallan  */
     28   1.1  macallan 
     29   1.1  macallan #include <sys/cdefs.h>
     30  1.14  macallan __KERNEL_RCSID(0, "$NetBSD: adb_bus.c,v 1.14 2025/06/16 07:51:16 macallan Exp $");
     31   1.1  macallan 
     32   1.1  macallan #include <sys/param.h>
     33   1.1  macallan #include <sys/device.h>
     34  1.14  macallan #include <sys/condvar.h>
     35   1.1  macallan 
     36   1.1  macallan #include <machine/autoconf.h>
     37   1.1  macallan #include <dev/adb/adbvar.h>
     38   1.1  macallan 
     39   1.1  macallan #include "adbdebug.h"
     40   1.1  macallan 
     41   1.1  macallan #ifdef ADB_DEBUG
     42   1.1  macallan #define DPRINTF printf
     43   1.1  macallan #else
     44   1.1  macallan #define DPRINTF while (0) printf
     45   1.1  macallan #endif
     46   1.1  macallan 
     47   1.7      matt static int nadb_match(device_t, cfdata_t, void *);
     48   1.7      matt static void nadb_attach(device_t, device_t, void *);
     49   1.1  macallan 
     50   1.1  macallan struct nadb_softc {
     51   1.7      matt 	device_t sc_dev;
     52   1.1  macallan 	struct adb_bus_accessops *sc_ops;
     53   1.1  macallan 	uint32_t sc_msg;
     54  1.14  macallan 	kcondvar_t sc_event;
     55  1.14  macallan 	kmutex_t sc_interlock;
     56   1.1  macallan 	struct adb_device sc_devtable[16];
     57   1.1  macallan 	int sc_free;	/* highest free address */
     58   1.1  macallan 	int sc_len;	/* length of received message */
     59   1.1  macallan 	uint8_t sc_data[16];
     60   1.1  macallan };
     61   1.1  macallan 
     62   1.7      matt CFATTACH_DECL_NEW(nadb, sizeof(struct nadb_softc),
     63   1.1  macallan     nadb_match, nadb_attach, NULL, NULL);
     64   1.1  macallan 
     65   1.9    cegger static void nadb_init(device_t);
     66   1.1  macallan static void nadb_handler(void *, int, uint8_t *);
     67   1.1  macallan static void nadb_send_sync(void *, int, int, uint8_t *);
     68   1.1  macallan static int nadb_register(struct nadb_softc *, int, int, int);
     69   1.1  macallan static void nadb_remove(struct nadb_softc *, int);
     70   1.1  macallan static int nadb_devprint(void *, const char *);
     71   1.1  macallan 
     72   1.1  macallan static int
     73   1.7      matt nadb_match(device_t parent, cfdata_t cf, void *aux)
     74   1.1  macallan {
     75   1.1  macallan 
     76   1.1  macallan 	return 1;
     77   1.1  macallan }
     78   1.1  macallan 
     79   1.1  macallan static void
     80   1.7      matt nadb_attach(device_t parent, device_t self, void *aux)
     81   1.1  macallan {
     82   1.7      matt 	struct nadb_softc *sc = device_private(self);
     83   1.1  macallan 	struct adb_bus_accessops *ops = aux;
     84   1.1  macallan 
     85   1.7      matt 	sc->sc_dev = self;
     86   1.1  macallan 	sc->sc_ops = ops;
     87   1.1  macallan 	sc->sc_ops->set_handler(sc->sc_ops->cookie, nadb_handler, sc);
     88   1.1  macallan 
     89  1.14  macallan 	mutex_init(&sc->sc_interlock, MUTEX_DEFAULT, IPL_NONE);
     90  1.14  macallan 	cv_init(&sc->sc_event, "adbbus");
     91  1.14  macallan 
     92   1.7      matt 	config_interrupts(self, nadb_init);
     93   1.1  macallan }
     94   1.1  macallan 
     95   1.1  macallan static void
     96   1.7      matt nadb_init(device_t dev)
     97   1.1  macallan {
     98   1.7      matt 	struct nadb_softc *sc = device_private(dev);
     99   1.1  macallan 	struct adb_attach_args aaa;
    100   1.1  macallan 	int i, last_moved_up, devmask = 0;
    101   1.1  macallan 	uint8_t cmd[2];
    102   1.1  macallan 
    103   1.1  macallan 	sc->sc_free = 15;
    104   1.1  macallan 	for (i = 0; i < 16; i++) {
    105   1.1  macallan 		sc->sc_devtable[i].original_addr = 0;
    106   1.1  macallan 		sc->sc_devtable[i].current_addr = 0;
    107   1.1  macallan 		sc->sc_devtable[i].handler_id = 0;
    108   1.1  macallan 		sc->sc_devtable[i].cookie = NULL;
    109   1.1  macallan 		sc->sc_devtable[i].handler = NULL;
    110   1.1  macallan 	}
    111   1.1  macallan 
    112   1.1  macallan 	/* bus reset (?) */
    113   1.4   tsutsui 	nadb_send_sync(sc, 0, 0, NULL);
    114   1.4   tsutsui 	delay(200000);
    115   1.1  macallan 
    116   1.1  macallan 	/*
    117   1.1  macallan 	 * scan only addresses 1 - 7
    118   1.1  macallan 	 * if something responds move it to >7 and see if something else is
    119   1.1  macallan 	 * there. If not move the previous one back.
    120   1.1  macallan 	 * XXX we don't check for collisions if we use up all addresses >7
    121   1.1  macallan 	 */
    122   1.1  macallan 	for (i = 1; i < 8; i++) {
    123   1.1  macallan 		DPRINTF("\n%d: ", i);
    124   1.1  macallan 		last_moved_up = 0;
    125   1.1  macallan 		nadb_send_sync(sc, ADBTALK(i, 3), 0, NULL);
    126   1.1  macallan 		/* found something? */
    127   1.1  macallan 		while (sc->sc_len > 2) {
    128   1.1  macallan 			/* something answered, so move it up */
    129   1.1  macallan 
    130   1.1  macallan 			DPRINTF("Found a device on address %d\n", i);
    131   1.1  macallan 			cmd[0] = sc->sc_free | 0x60;
    132   1.1  macallan 			cmd[1] = 0xfe;
    133   1.1  macallan 			nadb_send_sync(sc, ADBLISTEN(i, 3), 2, cmd);
    134   1.1  macallan 
    135   1.1  macallan 			/* see if it really moved */
    136   1.1  macallan 			nadb_send_sync(sc, ADBTALK(sc->sc_free, 3), 0, NULL);
    137   1.1  macallan 			if (sc->sc_len > 2) {
    138   1.1  macallan 				/* ok */
    139   1.1  macallan 				DPRINTF("moved it to %d\n", sc->sc_free);
    140   1.1  macallan 				nadb_register(sc, sc->sc_free, i, sc->sc_data[3]);
    141   1.1  macallan 				last_moved_up = sc->sc_free;
    142   1.1  macallan 				sc->sc_free--;
    143   1.1  macallan 			}
    144   1.1  macallan 			/* see if something else is there */
    145   1.1  macallan 			nadb_send_sync(sc, ADBTALK(i, 3), 0, NULL);
    146   1.1  macallan 		}
    147   1.1  macallan 		if (last_moved_up != 0) {
    148   1.1  macallan 			/* move last one back to original address */
    149   1.1  macallan 			cmd[0] = i | 0x60;
    150   1.1  macallan 			cmd[1] = 0xfe;
    151   1.1  macallan 			nadb_send_sync(sc, ADBLISTEN(last_moved_up, 3), 2, cmd);
    152   1.1  macallan 
    153   1.1  macallan 			nadb_send_sync(sc, ADBTALK(i, 3), 0, NULL);
    154   1.1  macallan 			if (sc->sc_len > 2) {
    155   1.1  macallan 				DPRINTF("moved %d back to %d\n", last_moved_up, i);
    156   1.1  macallan 				nadb_remove(sc, last_moved_up);
    157   1.1  macallan 				nadb_register(sc, i, i, sc->sc_data[3]);
    158   1.1  macallan 				sc->sc_free = last_moved_up;
    159   1.1  macallan 			}
    160   1.1  macallan 		}
    161   1.1  macallan 	}
    162   1.1  macallan 
    163   1.1  macallan 	/* now attach the buggers we've found */
    164   1.1  macallan 	aaa.ops = sc->sc_ops;
    165   1.1  macallan 	for (i = 0; i < 16; i++) {
    166   1.1  macallan 		if (sc->sc_devtable[i].current_addr != 0) {
    167   1.1  macallan 			DPRINTF("dev: %d %d %02x\n",
    168   1.1  macallan 			    sc->sc_devtable[i].current_addr,
    169   1.1  macallan 			    sc->sc_devtable[i].original_addr,
    170   1.1  macallan 			    sc->sc_devtable[i].handler_id);
    171   1.1  macallan 			aaa.dev = &sc->sc_devtable[i];
    172  1.11   thorpej 			if (config_found(sc->sc_dev, &aaa, nadb_devprint,
    173  1.12   thorpej 					 CFARGS_NONE)) {
    174   1.1  macallan 				devmask |= (1 << i);
    175   1.1  macallan 			} else {
    176  1.10  macallan 				aprint_normal(" not configured\n");
    177   1.1  macallan 			}
    178   1.1  macallan 		}
    179   1.1  macallan 	}
    180   1.1  macallan 	/* now enable autopolling */
    181   1.1  macallan 	DPRINTF("devmask: %04x\n", devmask);
    182   1.1  macallan 	sc->sc_ops->autopoll(sc->sc_ops->cookie, devmask);
    183   1.1  macallan }
    184   1.1  macallan 
    185   1.1  macallan int
    186   1.1  macallan nadb_print(void *aux, const char *what)
    187   1.1  macallan {
    188  1.10  macallan 	aprint_normal(": Apple Desktop Bus\n");
    189   1.1  macallan 	return 0;
    190   1.1  macallan }
    191   1.1  macallan 
    192   1.1  macallan static int
    193   1.1  macallan nadb_devprint(void *aux, const char *what)
    194   1.1  macallan {
    195   1.1  macallan 	struct adb_attach_args *aaa = aux;
    196   1.1  macallan 
    197   1.5  macallan 	if (what == NULL)
    198   1.5  macallan 		return 0;
    199   1.5  macallan 
    200   1.1  macallan 	switch(aaa->dev->original_addr) {
    201  1.13  macallan 		case ADBADDR_KBD:
    202  1.10  macallan 			aprint_normal("%s: ADB Keyboard", what);
    203   1.1  macallan 			break;
    204  1.13  macallan 		case ADBADDR_MS:
    205  1.10  macallan 			aprint_normal("%s: ADB relative pointing device", what);
    206   1.1  macallan 			break;
    207   1.1  macallan 		default:
    208  1.10  macallan 			aprint_normal("%s: something from address %d:%02x",
    209   1.5  macallan 			    what,
    210   1.1  macallan 			    aaa->dev->original_addr,
    211   1.1  macallan 			    aaa->dev->handler_id);
    212   1.1  macallan 			break;
    213   1.1  macallan 	}
    214   1.1  macallan 	return 0;
    215   1.1  macallan }
    216   1.1  macallan 
    217   1.1  macallan static void
    218   1.1  macallan nadb_handler(void *cookie, int len, uint8_t *data)
    219   1.1  macallan {
    220   1.1  macallan 	struct nadb_softc *sc = cookie;
    221   1.1  macallan 	struct adb_device *dev;
    222   1.1  macallan 	int addr;
    223   1.1  macallan 
    224   1.1  macallan #ifdef ADB_DEBUG
    225   1.1  macallan 	int i;
    226   1.1  macallan 	printf("adb:");
    227   1.1  macallan 	for (i = 0; i < len; i++) {
    228   1.1  macallan 		printf(" %02x", data[i]);
    229   1.1  macallan 	}
    230   1.1  macallan 	printf("\n");
    231   1.1  macallan #endif
    232   1.1  macallan 
    233   1.1  macallan 	addr = data[1] >> 4;
    234   1.1  macallan 	dev  = &sc->sc_devtable[addr];
    235   1.1  macallan 	if ((dev->current_addr != 0) && (dev->handler != NULL)) {
    236   1.1  macallan 
    237   1.1  macallan 		dev->handler(dev->cookie, len, data);
    238   1.1  macallan 	} else {
    239   1.1  macallan 		sc->sc_msg = 1;
    240   1.1  macallan 		sc->sc_len = len;
    241   1.1  macallan 		memcpy(sc->sc_data, data, len);
    242  1.14  macallan 		cv_signal(&sc->sc_event);
    243   1.1  macallan 	}
    244   1.1  macallan }
    245   1.1  macallan 
    246   1.1  macallan static void
    247   1.1  macallan nadb_send_sync(void *cookie, int command, int len, uint8_t *data)
    248   1.1  macallan {
    249   1.1  macallan 	struct nadb_softc *sc = cookie;
    250   1.1  macallan 
    251   1.1  macallan 	sc->sc_msg = 0;
    252  1.14  macallan 	mutex_enter(&sc->sc_interlock);
    253   1.1  macallan 	sc->sc_ops->send(sc->sc_ops->cookie, 0, command, len, data);
    254   1.1  macallan 	while (sc->sc_msg == 0) {
    255  1.14  macallan 		cv_timedwait(&sc->sc_event, &sc->sc_interlock, hz);
    256   1.1  macallan 	}
    257  1.14  macallan 	mutex_exit(&sc->sc_interlock);
    258   1.1  macallan }
    259   1.1  macallan 
    260   1.1  macallan static int
    261   1.1  macallan nadb_register(struct nadb_softc *sc, int current, int orig, int handler)
    262   1.1  macallan {
    263   1.1  macallan 	struct adb_device *dev;
    264   1.1  macallan 
    265   1.1  macallan 	if ((current > 0) && (current < 16)) {
    266   1.1  macallan 		dev = &sc->sc_devtable[current];
    267   1.1  macallan 		if (dev->current_addr != 0)
    268   1.1  macallan 			/* in use! */
    269   1.1  macallan 			return -1;
    270   1.1  macallan 		dev->current_addr = current;
    271   1.1  macallan 		dev->original_addr = orig;
    272   1.1  macallan 		dev->handler_id = handler;
    273   1.1  macallan 		return 0;
    274   1.1  macallan 	}
    275   1.1  macallan 	return -1;
    276   1.1  macallan }
    277   1.1  macallan 
    278   1.1  macallan static void
    279   1.1  macallan nadb_remove(struct nadb_softc *sc, int addr)
    280   1.1  macallan {
    281   1.1  macallan 
    282   1.1  macallan 	if ((addr > 0) && (addr < 16)) {
    283   1.1  macallan 		sc->sc_devtable[addr].current_addr = 0;
    284   1.1  macallan 		sc->sc_devtable[addr].original_addr = 0;
    285   1.1  macallan 		sc->sc_devtable[addr].handler_id = 0;
    286   1.1  macallan 	}
    287   1.1  macallan }
    288