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