NetBSD/sys/arch/hppa/gsc/fdc_gsc.c

97 lines
2.9 KiB
C

/* $NetBSD: fdc_gsc.c,v 1.1 2014/02/24 07:23:43 skrll Exp $ */
/* $OpenBSD: fdc_gsc.c,v 1.1 1998/09/30 04:45:46 mickey Exp $ */
/*
* Copyright (c) 1998 Michael Shalayeff
* 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 THE AUTHOR OR HIS RELATIVES 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 MIND, 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.
*/
#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: fdc_gsc.c,v 1.1 2014/02/24 07:23:43 skrll Exp $");
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/device.h>
#include <machine/iomod.h>
#include <sys/bus.h>
#include <machine/intr.h>
#include <machine/autoconf.h>
#include <dev/ic/fdreg.h>
#include <dev/ic/fdlink.h>
#include <hppa/dev/cpudevs.h>
/* controller driver configuration */
int fdc_gsc_probe(device_t, cfdata_t, void *);
void fdc_gsc_attach(device_t, device_t, void *);
CFATTACH_DECL_NEW(fdc_gsc, sizeof(struct fdc_softc),
fdc_gsc_probe, fdc_gsc_attach, NULL, NULL);
int
fdc_gsc_probe(device_t parent, cfdata_t match, void *aux)
{
struct confargs *ca = aux;
bus_space_handle_t ioh;
int rv;
if (ca->ca_type.iodc_type != HPPA_TYPE_FIO ||
ca->ca_type.iodc_sv_model != HPPA_FIO_GPCFD)
return 0;
/* Map the i/o space. */
if (bus_space_map(ca->ca_iot, ca->ca_hpa, IOMOD_HPASIZE, 0, &ioh))
return 0;
rv = fdcprobe1(ca->ca_iot, ioh | IOMOD_DEVOFFSET);
bus_space_unmap(ca->ca_iot, ioh, IOMOD_HPASIZE);
return rv;
}
void
fdc_gsc_attach(device_t parent, device_t self, void *aux)
{
struct fdc_softc *sc = device_private(self);
bus_space_handle_t ioh;
struct confargs *ca = aux;
sc->sc_dev = self;
/* Re-map the I/O space. */
if (bus_space_map(ca->ca_iot, ca->ca_hpa, IOMOD_HPASIZE, 0, &ioh)) {
aprint_error(": can't map I/O ports\n");
return;
}
ioh |= IOMOD_DEVOFFSET;
sc->sc_iot = ca->ca_iot;
sc->sc_ioh = ioh;
sc->sc_ioh_ctl = ioh + FDCTL_OFFSET;
fdc_attach_subr(sc);
}