NetBSD/sys/dev/bi/kdb.c

341 lines
9.1 KiB
C

/* $NetBSD: kdb.c,v 1.17 2000/03/26 11:45:04 ragge Exp $ */
/*
* Copyright (c) 1996 Ludd, University of Lule}, Sweden.
* 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.
* 3. All advertising materials mentioning features or use of this software
* must display the following acknowledgement:
* This product includes software developed at Ludd, University of
* Lule}, Sweden and its contributors.
* 4. The name of the author may not be used to endorse or promote products
* derived from this software without specific prior written permission
*
* 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 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.
*/
/*
* KDB50 disk device driver
*/
/*
* TODO
* Implement node reset routine.
* Nices hardware error handling.
*/
#include <sys/param.h>
#include <sys/kernel.h>
#include <sys/buf.h>
#include <sys/device.h>
#include <sys/proc.h>
#include <sys/user.h>
#include <sys/malloc.h>
#include <sys/systm.h>
#include <vm/vm.h>
#include <vm/vm_kern.h>
#ifdef __vax__
#include <machine/pte.h>
#include <machine/pcb.h>
#endif
#include <machine/bus.h>
#include <dev/bi/bireg.h>
#include <dev/bi/bivar.h>
#include <dev/bi/kdbreg.h>
#include <dev/mscp/mscp.h>
#include <dev/mscp/mscpreg.h>
#include <dev/mscp/mscpvar.h>
#include "locators.h"
#define KDB_WL(adr, val) bus_space_write_4(sc->sc_iot, sc->sc_ioh, adr, val)
#define KDB_RL(adr) bus_space_read_4(sc->sc_iot, sc->sc_ioh, adr)
#define KDB_RS(adr) bus_space_read_2(sc->sc_iot, sc->sc_ioh, adr)
#define b_forw b_hash.le_next
/*
* Software status, per controller.
*/
struct kdb_softc {
struct device sc_dev; /* Autoconfig info */
caddr_t sc_kdb; /* Struct for kdb communication */
struct mscp_softc *sc_softc; /* MSCP info (per mscpvar.h) */
bus_dma_tag_t sc_dmat;
bus_dmamap_t sc_cmap; /* Control structures */
bus_space_tag_t sc_iot;
bus_space_handle_t sc_ioh;
};
int kdbmatch __P((struct device *, struct cfdata *, void *));
void kdbattach __P((struct device *, struct device *, void *));
void kdbreset __P((int));
void kdbintr __P((void *));
void kdbctlrdone __P((struct device *));
int kdbprint __P((void *, const char *));
void kdbsaerror __P((struct device *, int));
void kdbgo __P((struct device *, struct mscp_xi *));
struct cfattach kdb_ca = {
sizeof(struct kdb_softc), kdbmatch, kdbattach
};
/*
* More driver definitions, for generic MSCP code.
*/
struct mscp_ctlr kdb_mscp_ctlr = {
kdbctlrdone,
kdbgo,
kdbsaerror,
};
int
kdbprint(aux, name)
void *aux;
const char *name;
{
if (name)
printf("%s: mscpbus", name);
return UNCONF;
}
/*
* Poke at a supposed KDB to see if it is there.
*/
int
kdbmatch(parent, cf, aux)
struct device *parent;
struct cfdata *cf;
void *aux;
{
struct bi_attach_args *ba = aux;
if (bus_space_read_2(ba->ba_iot, ba->ba_ioh, BIREG_DTYPE) != BIDT_KDB50)
return 0;
if (cf->cf_loc[BICF_NODE] != BICF_NODE_DEFAULT &&
cf->cf_loc[BICF_NODE] != ba->ba_nodenr)
return 0;
return 1;
}
void
kdbattach(parent, self, aux)
struct device *parent, *self;
void *aux;
{
struct kdb_softc *sc = (void *)self;
struct bi_attach_args *ba = aux;
struct mscp_attach_args ma;
volatile int i = 10000;
int error, rseg;
bus_dma_segment_t seg;
printf("\n");
bi_intr_establish(ba->ba_icookie, ba->ba_ivec, kdbintr, sc);
sc->sc_iot = ba->ba_iot;
sc->sc_ioh = ba->ba_ioh;
sc->sc_dmat = ba->ba_dmat;
/*
* Map the communication area and command and
* response packets into Unibus space.
*/
if ((error = bus_dmamem_alloc(sc->sc_dmat, sizeof(struct mscp_pack),
NBPG, 0, &seg, 1, &rseg, BUS_DMA_NOWAIT)) != 0) {
printf("Alloc ctrl area %d\n", error);
return;
}
if ((error = bus_dmamem_map(sc->sc_dmat, &seg, rseg,
sizeof(struct mscp_pack), &sc->sc_kdb,
BUS_DMA_NOWAIT|BUS_DMA_COHERENT)) != 0) {
printf("Map ctrl area %d\n", error);
err: bus_dmamem_free(sc->sc_dmat, &seg, rseg);
return;
}
if ((error = bus_dmamap_create(sc->sc_dmat, sizeof(struct mscp_pack),
1, sizeof(struct mscp_pack), 0, BUS_DMA_NOWAIT, &sc->sc_cmap))) {
printf("Create DMA map %d\n", error);
err2: bus_dmamem_unmap(sc->sc_dmat, sc->sc_kdb,
sizeof(struct mscp_pack));
goto err;
}
if ((error = bus_dmamap_load(sc->sc_dmat, sc->sc_cmap,
sc->sc_kdb, sizeof(struct mscp_pack), 0, BUS_DMA_NOWAIT))) {
printf("Load ctrl map %d\n", error);
bus_dmamap_destroy(sc->sc_dmat, sc->sc_cmap);
goto err2;
}
bzero(sc->sc_kdb, sizeof(struct mscp_pack));
ma.ma_mc = &kdb_mscp_ctlr;
ma.ma_type = MSCPBUS_DISK|MSCPBUS_KDB;
ma.ma_uda = (struct mscp_pack *)sc->sc_kdb;
ma.ma_softc = &sc->sc_softc;
ma.ma_iot = sc->sc_iot;
ma.ma_iph = sc->sc_ioh + KDB_IP;
ma.ma_sah = sc->sc_ioh + KDB_SA;
ma.ma_swh = sc->sc_ioh + KDB_SW;
ma.ma_dmat = sc->sc_dmat;
ma.ma_dmam = sc->sc_cmap;
ma.ma_ivec = ba->ba_ivec;
ma.ma_ctlrnr = ba->ba_nodenr;
ma.ma_adapnr = ba->ba_busnr;
KDB_WL(BIREG_VAXBICSR, KDB_RL(BIREG_VAXBICSR) | BICSR_NRST);
while (i--) /* Need delay??? */
;
KDB_WL(BIREG_INTRDES, ba->ba_intcpu); /* Interrupt on CPU # */
KDB_WL(BIREG_BCICSR, KDB_RL(BIREG_BCICSR) |
BCI_STOPEN | BCI_IDENTEN | BCI_UINTEN | BCI_INTEN);
KDB_WL(BIREG_UINTRCSR, ba->ba_ivec);
config_found(&sc->sc_dev, &ma, kdbprint);
}
void
kdbgo(usc, mxi)
struct device *usc;
struct mscp_xi *mxi;
{
struct kdb_softc *sc = (void *)usc;
struct buf *bp = mxi->mxi_bp;
struct mscp *mp = mxi->mxi_mp;
u_int32_t addr = (u_int32_t)bp->b_un.b_addr;
u_int32_t mapaddr;
int err;
/*
* The KDB50 wants to read VAX Page tables directly, therefore
* the result from bus_dmamap_load() is uninteresting. (But it
* should never fail!).
*
* On VAX, point to the corresponding page tables. (user/sys)
* On other systems, do something else...
*/
err = bus_dmamap_load(sc->sc_dmat, mxi->mxi_dmam, bp->b_un.b_addr,
bp->b_bcount, bp->b_proc, BUS_DMA_NOWAIT);
if (err) /* Shouldn't happen */
panic("kdbgo: bus_dmamap_load: error %d", err);
#ifdef __vax__
/*
* Get a pointer to the pte pointing out the first virtual address.
* Use different ways in kernel and user space.
*/
if ((bp->b_flags & B_PHYS) == 0) {
mapaddr = ((u_int32_t)kvtopte(addr)) & ~KERNBASE;
} else {
struct pcb *pcb;
u_int32_t eaddr;
/*
* We check if the PTE's needed crosses a page boundary.
* If they do; only transfer the amount of data that is
* mapped by the first PTE page and led the system handle
* the rest of the data.
*/
pcb = &bp->b_proc->p_addr->u_pcb;
mapaddr = (u_int32_t)uvtopte(addr, pcb);
eaddr = (u_int32_t)uvtopte(addr + (bp->b_bcount - 1), pcb);
if (trunc_page(mapaddr) != trunc_page(eaddr)) {
mp->mscp_seq.seq_bytecount =
(((round_page(mapaddr) - mapaddr)/4) * 512);
}
mapaddr = kvtophys(mapaddr);
}
#else
#error Must write code to handle KDB50 on non-vax.
#endif
mp->mscp_seq.seq_mapbase = mapaddr;
mxi->mxi_dmam->dm_segs[0].ds_addr = (addr & 511) | KDB_MAP;
mscp_dgo(sc->sc_softc, mxi);
}
void
kdbsaerror(usc, doreset)
struct device *usc;
int doreset;
{
struct kdb_softc *sc = (void *)usc;
if ((KDB_RS(KDB_SA) & MP_ERR) == 0)
return;
printf("%s: controller error, sa=0x%x\n", sc->sc_dev.dv_xname,
KDB_RS(KDB_SA));
/* What to do now??? */
}
/*
* Interrupt routine. Depending on the state of the controller,
* continue initialisation, or acknowledge command and response
* interrupts, and process responses.
*/
void
kdbintr(void *arg)
{
struct kdb_softc *sc = arg;
if (KDB_RS(KDB_SA) & MP_ERR) { /* ctlr fatal error */
kdbsaerror(&sc->sc_dev, 1);
return;
}
mscp_intr(sc->sc_softc);
}
#ifdef notyet
/*
* The KDB50 has been reset. Reinitialise the controller
* and requeue outstanding I/O.
*/
void
kdbreset(ctlr)
int ctlr;
{
struct kdb_softc *sc;
sc = kdb_cd.cd_devs[ctlr];
printf(" kdb%d", ctlr);
/* reset queues and requeue pending transfers */
mscp_requeue(sc->sc_softc);
/*
* If it fails to initialise we will notice later and
* try again (and again...). Do not call kdbstart()
* here; it will be done after the controller finishes
* initialisation.
*/
if (kdbinit(sc))
printf(" (hung)");
}
#endif
void
kdbctlrdone(usc)
struct device *usc;
{
}