svn commit: r184391 - in user/kmacy/HEAD_ECMP/sys/dev: adb age ar
ata ath ath/ath_rate/amrr ath/ath_rate/onoe
ath/ath_rate/sample bge ce cfe cfi drm hwpmc iwn lmc mii mxge
ofw pci ppbus ppc puc ral...
Kip Macy
kmacy at FreeBSD.org
Tue Oct 28 06:15:18 UTC 2008
Author: kmacy
Date: Tue Oct 28 06:15:18 2008
New Revision: 184391
URL: http://svn.freebsd.org/changeset/base/184391
Log:
IF_HEAD part2 184043:184389
Added:
user/kmacy/HEAD_ECMP/sys/dev/adb/
user/kmacy/HEAD_ECMP/sys/dev/adb/adb.h
user/kmacy/HEAD_ECMP/sys/dev/adb/adb_bus.c
user/kmacy/HEAD_ECMP/sys/dev/adb/adb_hb_if.m
user/kmacy/HEAD_ECMP/sys/dev/adb/adb_if.m
user/kmacy/HEAD_ECMP/sys/dev/adb/adb_kbd.c
user/kmacy/HEAD_ECMP/sys/dev/adb/adb_mouse.c
user/kmacy/HEAD_ECMP/sys/dev/adb/adbvar.h
user/kmacy/HEAD_ECMP/sys/dev/cfi/
user/kmacy/HEAD_ECMP/sys/dev/cfi/cfi_bus_lbc.c
user/kmacy/HEAD_ECMP/sys/dev/cfi/cfi_core.c
user/kmacy/HEAD_ECMP/sys/dev/cfi/cfi_dev.c
user/kmacy/HEAD_ECMP/sys/dev/cfi/cfi_reg.h
user/kmacy/HEAD_ECMP/sys/dev/cfi/cfi_var.h
user/kmacy/HEAD_ECMP/sys/dev/sdhci/
user/kmacy/HEAD_ECMP/sys/dev/sdhci/sdhci.c
user/kmacy/HEAD_ECMP/sys/dev/sdhci/sdhci.h
Modified:
user/kmacy/HEAD_ECMP/sys/dev/age/if_age.c
user/kmacy/HEAD_ECMP/sys/dev/age/if_agevar.h
user/kmacy/HEAD_ECMP/sys/dev/ar/if_ar.c
user/kmacy/HEAD_ECMP/sys/dev/ata/ata-dma.c
user/kmacy/HEAD_ECMP/sys/dev/ata/ata-queue.c
user/kmacy/HEAD_ECMP/sys/dev/ath/ah_osdep.c
user/kmacy/HEAD_ECMP/sys/dev/ath/ath_rate/amrr/amrr.c
user/kmacy/HEAD_ECMP/sys/dev/ath/ath_rate/onoe/onoe.c
user/kmacy/HEAD_ECMP/sys/dev/ath/ath_rate/sample/sample.c
user/kmacy/HEAD_ECMP/sys/dev/ath/if_ath.c
user/kmacy/HEAD_ECMP/sys/dev/ath/if_athrate.h
user/kmacy/HEAD_ECMP/sys/dev/ath/if_athvar.h
user/kmacy/HEAD_ECMP/sys/dev/bge/if_bge.c
user/kmacy/HEAD_ECMP/sys/dev/ce/if_ce.c
user/kmacy/HEAD_ECMP/sys/dev/cfe/cfe_console.c
user/kmacy/HEAD_ECMP/sys/dev/drm/drm_drv.c
user/kmacy/HEAD_ECMP/sys/dev/drm/drm_fops.c
user/kmacy/HEAD_ECMP/sys/dev/drm/drm_lock.c
user/kmacy/HEAD_ECMP/sys/dev/drm/i915_dma.c
user/kmacy/HEAD_ECMP/sys/dev/drm/radeon_cp.c
user/kmacy/HEAD_ECMP/sys/dev/drm/radeon_drv.h
user/kmacy/HEAD_ECMP/sys/dev/hwpmc/hwpmc_amd.c
user/kmacy/HEAD_ECMP/sys/dev/hwpmc/hwpmc_logging.c
user/kmacy/HEAD_ECMP/sys/dev/hwpmc/hwpmc_mod.c
user/kmacy/HEAD_ECMP/sys/dev/hwpmc/hwpmc_piv.c
user/kmacy/HEAD_ECMP/sys/dev/hwpmc/hwpmc_ppro.c
user/kmacy/HEAD_ECMP/sys/dev/hwpmc/hwpmc_x86.c
user/kmacy/HEAD_ECMP/sys/dev/iwn/if_iwn.c
user/kmacy/HEAD_ECMP/sys/dev/lmc/if_lmc.c
user/kmacy/HEAD_ECMP/sys/dev/mii/atphy.c
user/kmacy/HEAD_ECMP/sys/dev/mii/ciphy.c
user/kmacy/HEAD_ECMP/sys/dev/mii/miidevs
user/kmacy/HEAD_ECMP/sys/dev/mxge/eth_z8e.h
user/kmacy/HEAD_ECMP/sys/dev/mxge/ethp_z8e.h
user/kmacy/HEAD_ECMP/sys/dev/mxge/rss_eth_z8e.h
user/kmacy/HEAD_ECMP/sys/dev/mxge/rss_ethp_z8e.h
user/kmacy/HEAD_ECMP/sys/dev/ofw/ofw_console.c
user/kmacy/HEAD_ECMP/sys/dev/pci/pci.c
user/kmacy/HEAD_ECMP/sys/dev/pci/pcireg.h
user/kmacy/HEAD_ECMP/sys/dev/ppbus/if_plip.c
user/kmacy/HEAD_ECMP/sys/dev/ppbus/immio.c
user/kmacy/HEAD_ECMP/sys/dev/ppbus/lpbb.c
user/kmacy/HEAD_ECMP/sys/dev/ppbus/lpt.c
user/kmacy/HEAD_ECMP/sys/dev/ppbus/pcfclock.c
user/kmacy/HEAD_ECMP/sys/dev/ppbus/ppb_base.c
user/kmacy/HEAD_ECMP/sys/dev/ppbus/ppb_msq.c
user/kmacy/HEAD_ECMP/sys/dev/ppbus/ppbconf.c
user/kmacy/HEAD_ECMP/sys/dev/ppbus/ppbconf.h
user/kmacy/HEAD_ECMP/sys/dev/ppbus/ppi.c
user/kmacy/HEAD_ECMP/sys/dev/ppbus/pps.c
user/kmacy/HEAD_ECMP/sys/dev/ppbus/vpo.c
user/kmacy/HEAD_ECMP/sys/dev/ppbus/vpoio.c
user/kmacy/HEAD_ECMP/sys/dev/ppbus/vpoio.h
user/kmacy/HEAD_ECMP/sys/dev/ppc/ppc.c
user/kmacy/HEAD_ECMP/sys/dev/ppc/ppcreg.h
user/kmacy/HEAD_ECMP/sys/dev/puc/pucdata.c
user/kmacy/HEAD_ECMP/sys/dev/ral/rt2560.c
user/kmacy/HEAD_ECMP/sys/dev/ral/rt2661.c
user/kmacy/HEAD_ECMP/sys/dev/ray/if_ray.c
user/kmacy/HEAD_ECMP/sys/dev/ray/if_rayvar.h
user/kmacy/HEAD_ECMP/sys/dev/sound/pci/hda/hdac.c
user/kmacy/HEAD_ECMP/sys/dev/sr/if_sr.c
user/kmacy/HEAD_ECMP/sys/dev/uart/uart_tty.c
user/kmacy/HEAD_ECMP/sys/dev/usb/if_zyd.c
user/kmacy/HEAD_ECMP/sys/dev/usb/u3g.c
user/kmacy/HEAD_ECMP/sys/dev/usb/ubsa.c
user/kmacy/HEAD_ECMP/sys/dev/usb/ucom.c
user/kmacy/HEAD_ECMP/sys/dev/usb/udbp.c
user/kmacy/HEAD_ECMP/sys/dev/usb/ufoma.c
user/kmacy/HEAD_ECMP/sys/dev/wpi/if_wpi.c
user/kmacy/HEAD_ECMP/sys/dev/xen/console/console.c
Added: user/kmacy/HEAD_ECMP/sys/dev/adb/adb.h
==============================================================================
--- /dev/null 00:00:00 1970 (empty, because file is newly added)
+++ user/kmacy/HEAD_ECMP/sys/dev/adb/adb.h Tue Oct 28 06:15:18 2008 (r184391)
@@ -0,0 +1,78 @@
+/*-
+ * Copyright (C) 2008 Nathan Whitehorn
+ * 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 TOOLS GMBH 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.
+ *
+ * $FreeBSD$
+ */
+
+#ifndef _POWERPC_ADB_H_
+#define _POWERPC_ADB_H_
+
+#include "adb_hb_if.h"
+#include "adb_if.h"
+
+enum {
+ ADB_COMMAND_FLUSH = 0,
+ ADB_COMMAND_LISTEN = 2,
+ ADB_COMMAND_TALK = 3,
+};
+
+enum {
+ ADB_DEVICE_DONGLE = 0x01,
+ ADB_DEVICE_KEYBOARD = 0x02,
+ ADB_DEVICE_MOUSE = 0x03,
+ ADB_DEVICE_TABLET = 0x04,
+ ADB_DEVICE_MODEM = 0x05,
+
+ ADB_DEVICE_MISC = 0x07
+};
+
+struct adb_devinfo {
+ uint8_t address;
+ uint8_t default_address;
+ uint8_t handler_id;
+
+ uint16_t register3;
+};
+
+/* Pass packets down through the bus manager */
+u_int adb_send_packet(device_t dev, u_char command, u_char reg, int len,
+ u_char *data);
+u_int adb_set_autopoll(device_t dev, u_char enable);
+
+/* Pass packets up from the interface */
+u_int adb_receive_raw_packet(device_t dev, u_char status, u_char command,
+ int len, u_char *data);
+
+uint8_t adb_get_device_type(device_t dev);
+uint8_t adb_get_device_handler(device_t dev);
+uint8_t adb_set_device_handler(device_t dev, uint8_t newhandler);
+
+uint8_t adb_read_register(device_t dev, u_char reg, size_t *len, void *data);
+
+/* Bits for implementing ADB host bus adapters */
+extern devclass_t adb_devclass;
+extern driver_t adb_driver;
+
+#endif
+
Added: user/kmacy/HEAD_ECMP/sys/dev/adb/adb_bus.c
==============================================================================
--- /dev/null 00:00:00 1970 (empty, because file is newly added)
+++ user/kmacy/HEAD_ECMP/sys/dev/adb/adb_bus.c Tue Oct 28 06:15:18 2008 (r184391)
@@ -0,0 +1,384 @@
+/*-
+ * Copyright (C) 2008 Nathan Whitehorn
+ * 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 TOOLS GMBH 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.
+ *
+ * $FreeBSD$
+ */
+
+#include <sys/cdefs.h>
+#include <sys/param.h>
+#include <sys/systm.h>
+#include <sys/module.h>
+#include <sys/bus.h>
+#include <sys/conf.h>
+#include <sys/kernel.h>
+
+#include <machine/bus.h>
+
+#include <vm/vm.h>
+#include <vm/pmap.h>
+
+#include "adb.h"
+#include "adbvar.h"
+
+static int adb_bus_probe(device_t dev);
+static int adb_bus_attach(device_t dev);
+static int adb_bus_detach(device_t dev);
+static void adb_probe_nomatch(device_t dev, device_t child);
+static int adb_print_child(device_t dev, device_t child);
+
+static int adb_send_raw_packet_sync(device_t dev, uint8_t to, uint8_t command, uint8_t reg, int len, u_char *data);
+
+static char *adb_device_string[] = {
+ "HOST", "dongle", "keyboard", "mouse", "tablet", "modem", "RESERVED", "misc"
+};
+
+static device_method_t adb_bus_methods[] = {
+ /* Device interface */
+ DEVMETHOD(device_probe, adb_bus_probe),
+ DEVMETHOD(device_attach, adb_bus_attach),
+ DEVMETHOD(device_detach, adb_bus_detach),
+ DEVMETHOD(device_shutdown, bus_generic_shutdown),
+ DEVMETHOD(device_suspend, bus_generic_suspend),
+ DEVMETHOD(device_resume, bus_generic_resume),
+
+ /* Bus Interface */
+ DEVMETHOD(bus_probe_nomatch, adb_probe_nomatch),
+ DEVMETHOD(bus_print_child, adb_print_child),
+
+ { 0, 0 },
+};
+
+driver_t adb_driver = {
+ "adb",
+ adb_bus_methods,
+ sizeof(struct adb_softc),
+};
+
+devclass_t adb_devclass;
+
+static int
+adb_bus_probe(device_t dev)
+{
+ device_set_desc(dev, "Apple Desktop Bus");
+ return (0);
+}
+
+static int
+adb_bus_attach(device_t dev)
+{
+ struct adb_softc *sc = device_get_softc(dev);
+ uint8_t i, next_free;
+ uint16_t r3;
+
+ sc->sc_dev = dev;
+ sc->parent = device_get_parent(dev);
+
+ sc->packet_reply = 0;
+ sc->autopoll_mask = 0;
+
+ mtx_init(&sc->sc_sync_mtx,"adbsyn",NULL,MTX_DEF | MTX_RECURSE);
+
+ /* Initialize devinfo */
+ for (i = 0; i < 16; i++) {
+ sc->devinfo[i].address = i;
+ sc->devinfo[i].default_address = 0;
+ }
+
+ /* Reset ADB bus */
+ adb_send_raw_packet_sync(dev,0,ADB_COMMAND_BUS_RESET,0,0,NULL);
+ DELAY(1500);
+
+ /* Enumerate bus */
+ next_free = 8;
+
+ for (i = 1; i < 7; i++) {
+ int8_t first_relocated = -1;
+ int reply = 0;
+
+ do {
+ reply = adb_send_raw_packet_sync(dev,i,
+ ADB_COMMAND_TALK,3,0,NULL);
+
+ if (reply) {
+ /* If we got a response, relocate to next_free */
+ r3 = sc->devinfo[i].register3;
+ r3 &= 0xf000;
+ r3 |= ((uint16_t)(next_free) & 0x000f) << 8;
+ r3 |= 0x00fe;
+
+ adb_send_raw_packet_sync(dev,i, ADB_COMMAND_LISTEN,3,
+ sizeof(uint16_t),(u_char *)(&r3));
+
+ adb_send_raw_packet_sync(dev,next_free,
+ ADB_COMMAND_TALK,3,0,NULL);
+
+ sc->devinfo[next_free].default_address = i;
+ if (first_relocated < 0)
+ first_relocated = next_free;
+
+ next_free++;
+ } else if (first_relocated > 0) {
+ /* Collisions removed, relocate first device back */
+
+ r3 = sc->devinfo[i].register3;
+ r3 &= 0xf000;
+ r3 |= ((uint16_t)(i) & 0x000f) << 8;
+
+ adb_send_raw_packet_sync(dev,first_relocated,
+ ADB_COMMAND_LISTEN,3,
+ sizeof(uint16_t),(u_char *)(&r3));
+ adb_send_raw_packet_sync(dev,i,
+ ADB_COMMAND_TALK,3,0,NULL);
+
+ sc->devinfo[i].default_address = i;
+ sc->devinfo[(int)(first_relocated)].default_address = 0;
+ break;
+ }
+ } while (reply);
+ }
+
+ for (i = 0; i < 16; i++) {
+ if (sc->devinfo[i].default_address) {
+ sc->children[i] = device_add_child(dev, NULL, -1);
+ device_set_ivars(sc->children[i], &sc->devinfo[i]);
+ }
+ }
+
+ return (bus_generic_attach(dev));
+}
+
+static int adb_bus_detach(device_t dev)
+{
+ struct adb_softc *sc = device_get_softc(dev);
+
+ mtx_destroy(&sc->sc_sync_mtx);
+
+ return (bus_generic_detach(dev));
+}
+
+
+static void
+adb_probe_nomatch(device_t dev, device_t child)
+{
+ struct adb_devinfo *dinfo;
+
+ if (bootverbose) {
+ dinfo = device_get_ivars(child);
+
+ device_printf(dev,"ADB %s at device %d (no driver attached)\n",
+ adb_device_string[dinfo->default_address],dinfo->address);
+ }
+}
+
+u_int
+adb_receive_raw_packet(device_t dev, u_char status, u_char command, int len,
+ u_char *data)
+{
+ struct adb_softc *sc = device_get_softc(dev);
+ u_char addr = command >> 4;
+
+ if (len > 0 && (command & 0x0f) == ((ADB_COMMAND_TALK << 2) | 3)) {
+ memcpy(&sc->devinfo[addr].register3,data,2);
+ sc->devinfo[addr].handler_id = data[1];
+ }
+
+ if (sc->sync_packet == command) {
+ memcpy(sc->syncreg,data,(len > 8) ? 8 : len);
+ atomic_store_rel_int(&sc->packet_reply,len + 1);
+ }
+
+ if (sc->children[addr] != NULL) {
+ ADB_RECEIVE_PACKET(sc->children[addr],status,
+ (command & 0x0f) >> 2,command & 0x03,len,data);
+ }
+
+ return (0);
+}
+
+static int
+adb_print_child(device_t dev, device_t child)
+{
+ struct adb_devinfo *dinfo;
+ int retval = 0;
+
+ dinfo = device_get_ivars(child);
+
+ retval += bus_print_child_header(dev,child);
+ printf(" at device %d",dinfo->address);
+ retval += bus_print_child_footer(dev, child);
+
+ return (retval);
+}
+
+u_int
+adb_send_packet(device_t dev, u_char command, u_char reg, int len, u_char *data)
+{
+ u_char command_byte = 0;
+ struct adb_devinfo *dinfo;
+ struct adb_softc *sc;
+
+ sc = device_get_softc(device_get_parent(dev));
+ dinfo = device_get_ivars(dev);
+
+ command_byte |= dinfo->address << 4;
+ command_byte |= command << 2;
+ command_byte |= reg;
+
+ ADB_HB_SEND_RAW_PACKET(sc->parent, command_byte, len, data, 1);
+
+ return (0);
+}
+
+u_int
+adb_set_autopoll(device_t dev, u_char enable)
+{
+ struct adb_devinfo *dinfo;
+ struct adb_softc *sc;
+ uint16_t mod = 0;
+
+ sc = device_get_softc(device_get_parent(dev));
+ dinfo = device_get_ivars(dev);
+
+ mod = enable << dinfo->address;
+ if (enable) {
+ sc->autopoll_mask |= mod;
+ } else {
+ mod = ~mod;
+ sc->autopoll_mask &= mod;
+ }
+
+ ADB_HB_SET_AUTOPOLL_MASK(sc->parent,sc->autopoll_mask);
+
+ return (0);
+}
+
+uint8_t
+adb_get_device_type(device_t dev)
+{
+ struct adb_devinfo *dinfo;
+
+ dinfo = device_get_ivars(dev);
+ return (dinfo->default_address);
+}
+
+uint8_t
+adb_get_device_handler(device_t dev)
+{
+ struct adb_devinfo *dinfo;
+
+ dinfo = device_get_ivars(dev);
+ return (dinfo->handler_id);
+}
+
+static int
+adb_send_raw_packet_sync(device_t dev, uint8_t to, uint8_t command,
+ uint8_t reg, int len, u_char *data)
+{
+ u_char command_byte = 0;
+ struct adb_softc *sc;
+ int result = -1;
+ int i = 0;
+
+ sc = device_get_softc(dev);
+
+ command_byte |= to << 4;
+ command_byte |= command << 2;
+ command_byte |= reg;
+
+ /* Wait if someone else has a synchronous request pending */
+ mtx_lock(&sc->sc_sync_mtx);
+
+ sc->packet_reply = 0;
+ sc->sync_packet = command_byte;
+
+ ADB_HB_SEND_RAW_PACKET(sc->parent, command_byte, len, data, 1);
+
+ while (!atomic_fetchadd_int(&sc->packet_reply,0)) {
+ /* Sometimes CUDA controllers hang up during cold boots.
+ Try poking them. */
+ if (i > 10)
+ ADB_HB_CONTROLLER_POLL(sc->parent);
+
+ DELAY(100);
+ i++;
+ }
+
+ result = sc->packet_reply - 1;
+
+ /* Clear packet sync */
+ sc->packet_reply = 0;
+ sc->sync_packet = 0xffff; /* We can't match a 16 bit value */
+
+ mtx_unlock(&sc->sc_sync_mtx);
+
+ return (result);
+}
+
+uint8_t
+adb_set_device_handler(device_t dev, uint8_t newhandler)
+{
+ struct adb_softc *sc;
+ struct adb_devinfo *dinfo;
+ uint16_t newr3;
+
+ dinfo = device_get_ivars(dev);
+ sc = device_get_softc(device_get_parent(dev));
+
+ newr3 = dinfo->register3 & 0xff00;
+ newr3 |= (uint16_t)(newhandler);
+
+ adb_send_raw_packet_sync(sc->sc_dev,dinfo->address,
+ ADB_COMMAND_LISTEN, 3, sizeof(uint16_t), (u_char *)(&newr3));
+ adb_send_raw_packet_sync(sc->sc_dev,dinfo->address,
+ ADB_COMMAND_TALK, 3, 0, NULL);
+
+ return (dinfo->handler_id);
+}
+
+uint8_t
+adb_read_register(device_t dev, u_char reg,
+ size_t *len, void *data)
+{
+ struct adb_softc *sc;
+ struct adb_devinfo *dinfo;
+ size_t orig_len;
+
+ dinfo = device_get_ivars(dev);
+ sc = device_get_softc(device_get_parent(dev));
+
+ orig_len = *len;
+
+ mtx_lock(&sc->sc_sync_mtx);
+
+ *len = adb_send_raw_packet_sync(sc->sc_dev,dinfo->address,
+ ADB_COMMAND_TALK, reg, 0, NULL);
+
+ if (*len > 0)
+ memcpy(data,sc->syncreg,*len);
+
+ mtx_unlock(&sc->sc_sync_mtx);
+
+ return ((*len > 0) ? 0 : -1);
+}
+
Added: user/kmacy/HEAD_ECMP/sys/dev/adb/adb_hb_if.m
==============================================================================
--- /dev/null 00:00:00 1970 (empty, because file is newly added)
+++ user/kmacy/HEAD_ECMP/sys/dev/adb/adb_hb_if.m Tue Oct 28 06:15:18 2008 (r184391)
@@ -0,0 +1,58 @@
+#-
+# Copyright (c) 2008 Nathan Whitehorn
+# 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 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 AUTHOR 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.
+#
+# $FreeBSD$
+#
+
+#include <sys/bus.h>
+
+#include <dev/adb/adb.h>
+
+INTERFACE adb_hb;
+
+#
+# Bus level operations. These are used by the ADB bus manager, and are
+# required to inplement an ADB interface.
+#
+
+METHOD u_int send_raw_packet {
+ device_t dev;
+ u_char command_byte;
+
+ int len;
+ u_char *data;
+ u_char poll;
+};
+
+METHOD u_int controller_poll {
+ device_t dev;
+};
+
+METHOD u_int set_autopoll_mask {
+ device_t dev;
+
+ uint16_t mask;
+};
+
Added: user/kmacy/HEAD_ECMP/sys/dev/adb/adb_if.m
==============================================================================
--- /dev/null 00:00:00 1970 (empty, because file is newly added)
+++ user/kmacy/HEAD_ECMP/sys/dev/adb/adb_if.m Tue Oct 28 06:15:18 2008 (r184391)
@@ -0,0 +1,49 @@
+#-
+# Copyright (c) 2008 Nathan Whitehorn
+# 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 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 AUTHOR 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.
+#
+# $FreeBSD$
+#
+
+#include <sys/bus.h>
+
+#include <dev/adb/adb.h>
+
+INTERFACE adb;
+
+#
+# Driver level operations
+#
+
+METHOD u_int receive_packet {
+ device_t dev;
+
+ u_char status;
+ u_char command;
+ u_char reg;
+
+ int len;
+ u_char *data;
+};
+
Added: user/kmacy/HEAD_ECMP/sys/dev/adb/adb_kbd.c
==============================================================================
--- /dev/null 00:00:00 1970 (empty, because file is newly added)
+++ user/kmacy/HEAD_ECMP/sys/dev/adb/adb_kbd.c Tue Oct 28 06:15:18 2008 (r184391)
@@ -0,0 +1,692 @@
+/*-
+ * Copyright (C) 2008 Nathan Whitehorn
+ * 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 TOOLS GMBH 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.
+ *
+ * $FreeBSD$
+ */
+
+#include <sys/cdefs.h>
+#include <sys/param.h>
+#include <sys/systm.h>
+#include <sys/module.h>
+#include <sys/bus.h>
+#include <sys/conf.h>
+#include <sys/kbio.h>
+#include <sys/condvar.h>
+#include <sys/callout.h>
+#include <sys/kernel.h>
+
+#include <machine/bus.h>
+
+#include "opt_kbd.h"
+#include <dev/kbd/kbdreg.h>
+#include <dev/kbd/kbdtables.h>
+
+#include <vm/vm.h>
+#include <vm/pmap.h>
+
+#include "adb.h"
+
+#define KBD_DRIVER_NAME "akbd"
+
+#define AKBD_EMULATE_ATKBD 1
+
+static int adb_kbd_probe(device_t dev);
+static int adb_kbd_attach(device_t dev);
+static int adb_kbd_detach(device_t dev);
+static void akbd_repeat(void *xsc);
+
+static u_int adb_kbd_receive_packet(device_t dev, u_char status,
+ u_char command, u_char reg, int len, u_char *data);
+
+struct adb_kbd_softc {
+ keyboard_t sc_kbd;
+
+ device_t sc_dev;
+ struct mtx sc_mutex;
+ struct cv sc_cv;
+
+ int sc_mode;
+ int sc_state;
+
+ int have_led_control;
+
+ uint8_t buffer[8];
+ volatile int buffers;
+
+ struct callout sc_repeater;
+ int sc_repeatstart;
+ int sc_repeatcontinue;
+ uint8_t last_press;
+};
+
+static device_method_t adb_kbd_methods[] = {
+ /* Device interface */
+ DEVMETHOD(device_probe, adb_kbd_probe),
+ DEVMETHOD(device_attach, adb_kbd_attach),
+ DEVMETHOD(device_detach, adb_kbd_detach),
+ DEVMETHOD(device_shutdown, bus_generic_shutdown),
+ DEVMETHOD(device_suspend, bus_generic_suspend),
+ DEVMETHOD(device_resume, bus_generic_resume),
+
+ /* ADB interface */
+ DEVMETHOD(adb_receive_packet, adb_kbd_receive_packet),
+
+ { 0, 0 }
+};
+
+static driver_t adb_kbd_driver = {
+ "akbd",
+ adb_kbd_methods,
+ sizeof(struct adb_kbd_softc),
+};
+
+static devclass_t adb_kbd_devclass;
+
+DRIVER_MODULE(akbd, adb, adb_kbd_driver, adb_kbd_devclass, 0, 0);
+
+static const uint8_t adb_to_at_scancode_map[128] = { 30, 31, 32, 33, 35, 34,
+ 44, 45, 46, 47, 0, 48, 16, 17, 18, 19, 21, 20, 2, 3, 4, 5, 7, 6, 13,
+ 10, 8, 12, 9, 11, 27, 24, 22, 26, 23, 25, 28, 38, 36, 40, 37, 39, 43,
+ 51, 53, 49, 50, 52, 15, 57, 41, 14, 0, 1, 29, 0, 42, 58, 56, 97, 98,
+ 100, 95, 0, 0, 83, 0, 55, 0, 78, 0, 69, 0, 0, 0, 91, 89, 0, 74, 13, 0,
+ 0, 82, 79, 80, 81, 75, 76, 77, 71, 0, 72, 73, 0, 0, 0, 63, 64, 65, 61,
+ 66, 67, 0, 87, 0, 105, 0, 70, 0, 68, 0, 88, 0, 107, 102, 94, 96, 103,
+ 62, 99, 60, 101, 59, 54, 93, 90, 0, 0 };
+
+/* keyboard driver declaration */
+static int akbd_configure(int flags);
+static kbd_probe_t akbd_probe;
+static kbd_init_t akbd_init;
+static kbd_term_t akbd_term;
+static kbd_intr_t akbd_interrupt;
+static kbd_test_if_t akbd_test_if;
+static kbd_enable_t akbd_enable;
+static kbd_disable_t akbd_disable;
+static kbd_read_t akbd_read;
+static kbd_check_t akbd_check;
+static kbd_read_char_t akbd_read_char;
+static kbd_check_char_t akbd_check_char;
+static kbd_ioctl_t akbd_ioctl;
+static kbd_lock_t akbd_lock;
+static kbd_clear_state_t akbd_clear_state;
+static kbd_get_state_t akbd_get_state;
+static kbd_set_state_t akbd_set_state;
+static kbd_poll_mode_t akbd_poll;
+
+keyboard_switch_t akbdsw = {
+ akbd_probe,
+ akbd_init,
+ akbd_term,
+ akbd_interrupt,
+ akbd_test_if,
+ akbd_enable,
+ akbd_disable,
+ akbd_read,
+ akbd_check,
+ akbd_read_char,
+ akbd_check_char,
+ akbd_ioctl,
+ akbd_lock,
+ akbd_clear_state,
+ akbd_get_state,
+ akbd_set_state,
+ genkbd_get_fkeystr,
+ akbd_poll,
+ genkbd_diag,
+};
+
+KEYBOARD_DRIVER(akbd, akbdsw, akbd_configure);
+
+static int
+adb_kbd_probe(device_t dev)
+{
+ uint8_t type;
+
+ type = adb_get_device_type(dev);
+
+ if (type != ADB_DEVICE_KEYBOARD)
+ return (ENXIO);
+
+ switch(adb_get_device_handler(dev)) {
+ case 1:
+ device_set_desc(dev,"Apple Standard Keyboard");
+ break;
+ case 2:
+ device_set_desc(dev,"Apple Extended Keyboard");
+ break;
+ case 4:
+ device_set_desc(dev,"Apple ISO Keyboard");
+ break;
+ case 5:
+ device_set_desc(dev,"Apple Extended ISO Keyboard");
+ break;
+ case 8:
+ device_set_desc(dev,"Apple Keyboard II");
+ break;
+ case 9:
+ device_set_desc(dev,"Apple ISO Keyboard II");
+ break;
+ case 12:
+ device_set_desc(dev,"PowerBook Keyboard");
+ break;
+ case 13:
+ device_set_desc(dev,"PowerBook ISO Keyboard");
+ break;
+ case 24:
+ device_set_desc(dev,"PowerBook Extended Keyboard");
+ break;
+ case 27:
+ device_set_desc(dev,"Apple Design Keyboard");
+ break;
+ case 195:
+ device_set_desc(dev,"PowerBook G3 Keyboard");
+ break;
+ case 196:
+ device_set_desc(dev,"iBook Keyboard");
+ break;
+ default:
+ device_set_desc(dev,"ADB Keyboard");
+ break;
+ }
+
+ return (0);
+}
+
+static int
+ms_to_ticks(int ms)
+{
+ if (hz > 1000)
+ return ms*(hz/1000);
+
+ return ms/(1000/hz);
+}
+
+static int
+adb_kbd_attach(device_t dev)
+{
+ struct adb_kbd_softc *sc;
+ keyboard_switch_t *sw;
+
+ sw = kbd_get_switch(KBD_DRIVER_NAME);
+ if (sw == NULL) {
+ return ENXIO;
+ }
+
+ sc = device_get_softc(dev);
+ sc->sc_dev = dev;
+ sc->sc_mode = K_RAW;
+ sc->sc_state = 0;
+ sc->have_led_control = 0;
+ sc->buffers = 0;
+
+ /* Try stepping forward to the extended keyboard protocol */
+ adb_set_device_handler(dev,3);
+
+ mtx_init(&sc->sc_mutex,KBD_DRIVER_NAME,MTX_DEF,0);
+ cv_init(&sc->sc_cv,KBD_DRIVER_NAME);
+ callout_init(&sc->sc_repeater, 0);
+
+#ifdef AKBD_EMULATE_ATKBD
+ kbd_init_struct(&sc->sc_kbd, KBD_DRIVER_NAME, KB_101, 0, 0, 0, 0);
+ kbd_set_maps(&sc->sc_kbd, &key_map, &accent_map, fkey_tab,
+ sizeof(fkey_tab) / sizeof(fkey_tab[0]));
+#else
+ #error ADB raw mode not implemented
+#endif
+
+ KBD_FOUND_DEVICE(&sc->sc_kbd);
+ KBD_PROBE_DONE(&sc->sc_kbd);
+ KBD_INIT_DONE(&sc->sc_kbd);
+ KBD_CONFIG_DONE(&sc->sc_kbd);
+
+ (*sw->enable)(&sc->sc_kbd);
+
+ kbd_register(&sc->sc_kbd);
+
+#ifdef KBD_INSTALL_CDEV
+ if (kbd_attach(&sc->sc_kbd)) {
+ adb_kbd_detach(dev);
+ return ENXIO;
+ }
+#endif
+
+ adb_set_autopoll(dev,1);
+
+ /* Check (asynchronously) if we can read out the LED state from
+ this keyboard by reading the key state register */
+ adb_send_packet(dev,ADB_COMMAND_TALK,2,0,NULL);
+
+ return (0);
+}
+
+static int
+adb_kbd_detach(device_t dev)
+{
+ struct adb_kbd_softc *sc;
+ keyboard_t *kbd;
+
+ sc = device_get_softc(dev);
+
+ adb_set_autopoll(dev,0);
+ callout_stop(&sc->sc_repeater);
+
+ mtx_lock(&sc->sc_mutex);
+
+ kbd = kbd_get_keyboard(kbd_find_keyboard(KBD_DRIVER_NAME,
+ device_get_unit(dev)));
+
+ kbdd_disable(kbd);
+
+#ifdef KBD_INSTALL_CDEV
+ kbd_detach(kbd);
+#endif
+
+ kbdd_term(kbd);
+
+ mtx_unlock(&sc->sc_mutex);
+
+ mtx_destroy(&sc->sc_mutex);
+ cv_destroy(&sc->sc_cv);
+
+ return (0);
+}
+
+static u_int
+adb_kbd_receive_packet(device_t dev, u_char status,
+ u_char command, u_char reg, int len, u_char *data)
+{
+ struct adb_kbd_softc *sc;
+
+ sc = device_get_softc(dev);
+
+ if (command != ADB_COMMAND_TALK)
+ return 0;
+
+ if (reg == 2 && len == 2) {
+ sc->have_led_control = 1;
+ return 0;
+ }
+
+ if (reg != 0 || len != 2)
+ return (0);
+
+ mtx_lock(&sc->sc_mutex);
+ if ((data[0] & 0x7f) == 57 && sc->buffers < 7) {
+ /* Fake the down/up cycle for caps lock */
+ sc->buffer[sc->buffers++] = data[0] & 0x7f;
+ sc->buffer[sc->buffers++] = (data[0] & 0x7f) | (1 << 7);
+ } else {
+ sc->buffer[sc->buffers++] = data[0];
+ }
+
+ if (sc->buffer[sc->buffers-1] < 0xff)
+ sc->last_press = sc->buffer[sc->buffers-1];
+
+ if ((data[1] & 0x7f) == 57 && sc->buffers < 7) {
+ /* Fake the down/up cycle for caps lock */
+ sc->buffer[sc->buffers++] = data[1] & 0x7f;
+ sc->buffer[sc->buffers++] = (data[1] & 0x7f) | (1 << 7);
+ } else {
+ sc->buffer[sc->buffers++] = data[1];
+ }
+
+ if (sc->buffer[sc->buffers-1] < 0xff)
+ sc->last_press = sc->buffer[sc->buffers-1];
+
+ /* Stop any existing key repeating */
+ callout_stop(&sc->sc_repeater);
+
+ /* Schedule a repeat callback on keydown */
+ if (!(sc->last_press & (1 << 7))) {
+ callout_reset(&sc->sc_repeater,
+ ms_to_ticks(sc->sc_kbd.kb_delay1), akbd_repeat, sc);
+ }
+ mtx_unlock(&sc->sc_mutex);
+
+ cv_broadcast(&sc->sc_cv);
+
+ if (KBD_IS_ACTIVE(&sc->sc_kbd) && KBD_IS_BUSY(&sc->sc_kbd)) {
+ sc->sc_kbd.kb_callback.kc_func(&sc->sc_kbd,
+ KBDIO_KEYINPUT, sc->sc_kbd.kb_callback.kc_arg);
+ }
+
+ return (0);
+}
+
+static void
+akbd_repeat(void *xsc) {
+ struct adb_kbd_softc *sc = xsc;
+ int notify_kbd = 0;
+
+ /* Fake an up/down key repeat so long as we have the
+ free buffers */
+ mtx_lock(&sc->sc_mutex);
+ if (sc->buffers < 7) {
+ sc->buffer[sc->buffers++] = sc->last_press | (1 << 7);
+ sc->buffer[sc->buffers++] = sc->last_press;
+
+ notify_kbd = 1;
+ }
+ mtx_unlock(&sc->sc_mutex);
+
+ if (notify_kbd && KBD_IS_ACTIVE(&sc->sc_kbd)
+ && KBD_IS_BUSY(&sc->sc_kbd)) {
+ sc->sc_kbd.kb_callback.kc_func(&sc->sc_kbd,
+ KBDIO_KEYINPUT, sc->sc_kbd.kb_callback.kc_arg);
+ }
+
+ /* Reschedule the callout */
+ callout_reset(&sc->sc_repeater, ms_to_ticks(sc->sc_kbd.kb_delay2),
+ akbd_repeat, sc);
+}
+
+static int
+akbd_configure(int flags)
+{
+ return 0;
+}
+
+static int
+akbd_probe(int unit, void *arg, int flags)
+{
+ return 0;
+}
+
+static int
*** DIFF OUTPUT TRUNCATED AT 1000 LINES ***
More information about the svn-src-user
mailing list