sys/dev/isapnp/joy_isapnp.c

   1 /*      $NetBSD: joy_isapnp.c,v 1.11 2008/03/26 18:27:07 xtraeme Exp $  */
   2
   3 /*-
   4  * Copyright (c) 1996 The NetBSD Foundation, Inc.
   5  * All rights reserved.
   6  *
   7  * This code is derived from software contributed to The NetBSD Foundation
   8  * by Jason R. Thorpe.
   9  *
  10  * Redistribution and use in source and binary forms, with or without
  11  * modification, are permitted provided that the following conditions
  12  * are met:
  13  * 1. Redistributions of source code must retain the above copyright
  14  *    notice, this list of conditions and the following disclaimer.
  15  * 2. Redistributions in binary form must reproduce the above copyright
  16  *    notice, this list of conditions and the following disclaimer in the
  17  *    documentation and/or other materials provided with the distribution.
  18  *
  19  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
  20  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
  21  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
  22  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
  23  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
  24  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
  25  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
  26  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
  27  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
  28  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
  29  * POSSIBILITY OF SUCH DAMAGE.
  30  */
  31
  32 #include <sys/cdefs.h>
  33 __KERNEL_RCSID(0, "$NetBSD: joy_isapnp.c,v 1.11 2008/03/26 18:27:07 xtraeme Exp $");
  34
  35 #include <sys/param.h>
  36 #include <sys/systm.h>
  37 #include <sys/kernel.h>
  38 #include <sys/device.h>
  39
  40 #include <sys/bus.h>
  41
  42 #include <dev/isa/isavar.h>
  43 #include <dev/isapnp/isapnpreg.h>
  44 #include <dev/isapnp/isapnpvar.h>
  45 #include <dev/isapnp/isapnpdevs.h>
  46
  47 #include <dev/ic/joyvar.h>
  48
  49 static int      joy_isapnp_match(device_t, cfdata_t, void *);
  50 static void     joy_isapnp_attach(device_t, device_t, void *);
  51
  52 CFATTACH_DECL_NEW(joy_isapnp, sizeof(struct joy_softc),
  53     joy_isapnp_match, joy_isapnp_attach, NULL, NULL);
  54
  55 static int
  56 joy_isapnp_match(device_t parent, cfdata_t match, void *aux)
  57 {
  58         int pri, variant;
  59
  60         pri = isapnp_devmatch(aux, &isapnp_joy_devinfo, &variant);
  61         if (pri && variant > 0)
  62                 pri = 0;
  63         return pri;
  64 }
  65
  66 static void
  67 joy_isapnp_attach(device_t parent, device_t self, void *aux)
  68 {
  69         struct joy_softc *sc = device_private(self);
  70         struct isapnp_attach_args *ipa = aux;
  71         bus_space_handle_t ioh;
  72
  73         aprint_normal("\n");
  74
  75         if (isapnp_config(ipa->ipa_iot, ipa->ipa_memt, ipa)) {
  76                 aprint_error_dev(self, "error in region allocation\n");
  77                 return;
  78         }
  79
  80         if (ipa->ipa_io[0].length == 8) {
  81                 if (bus_space_subregion(ipa->ipa_iot, ipa->ipa_io[0].h, 1, 1,
  82                     &ioh) < 0) {
  83                         aprint_error_dev(self, "error in region allocation\n");
  84                         return;
  85                 }
  86         } else
  87                 ioh = ipa->ipa_io[0].h;
  88
  89         sc->sc_iot = ipa->ipa_iot;
  90         sc->sc_ioh = ioh;
  91         sc->sc_dev = self;
  92
  93         aprint_normal_dev(self, "%s %s\n", ipa->ipa_devident,
  94             ipa->ipa_devclass);
  95
  96         joyattach(sc);
  97 }